KR20190135157A - Method for predicting and avoiding collision and conflict/conjunction among moving objects - Google Patents
Method for predicting and avoiding collision and conflict/conjunction among moving objects Download PDFInfo
- Publication number
- KR20190135157A KR20190135157A KR1020180060257A KR20180060257A KR20190135157A KR 20190135157 A KR20190135157 A KR 20190135157A KR 1020180060257 A KR1020180060257 A KR 1020180060257A KR 20180060257 A KR20180060257 A KR 20180060257A KR 20190135157 A KR20190135157 A KR 20190135157A
- Authority
- KR
- South Korea
- Prior art keywords
- moving
- collision
- event
- objects
- spheres
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 117
- 238000010586 diagram Methods 0.000 claims abstract description 329
- 238000012544 monitoring process Methods 0.000 claims abstract description 40
- 230000001174 ascending effect Effects 0.000 claims abstract description 7
- 238000004364 calculation method Methods 0.000 claims description 29
- 230000033001 locomotion Effects 0.000 claims description 26
- 238000000605 extraction Methods 0.000 claims description 8
- 238000012937 correction Methods 0.000 claims description 5
- 238000005070 sampling Methods 0.000 description 4
- 238000004458 analytical method Methods 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 239000002023 wood Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G9/00—Traffic control systems for craft where the kind of craft is irrelevant or unspecified
- G08G9/02—Anti-collision systems
-
- 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
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Processing Or Creating Images (AREA)
- Image Analysis (AREA)
Abstract
Description
본 발명은 다수의 이동체들 사이의 충돌 예측 및 근접관계의 회피 방법에 관련된 것으로, 보다 상세하게는 다수의 이동체들을 2차원 또는 3차원의 기하학적 형상으로 모델링하고, 상기 기하학적 형상들에 대해 보로노이 다이어그램을 연산하고, 상기 기하학적 형상들의 동적 데이터와 상기 보로노이 다이어그램의 위상 정보들을 이용하여 상기 기하학적 형상들의 충돌 및 근접관계를 예측하고, 회피하는 방법에 관한 것이다.The present invention relates to a collision prediction method and a method of avoiding proximity between a plurality of moving objects, and more particularly, to model a plurality of moving objects in a two-dimensional or three-dimensional geometric shape, and a Voronoi diagram for the geometric shapes. And predicting and avoiding collisions and proximity of the geometric shapes using dynamic data of the geometric shapes and phase information of the Voronoi diagram.
육상에서 교통사고로 많은 사상자가 발생하는 것과 유사하게 해상에서도 선박들 사이에 충돌사고가 빈번하게 발생하며 많은 사상자가 생긴다. 또한, 비행기들 사이에도 상공에서 충돌사고가 종종 발생하며 그 결과 매우 많은 사망자가 발생한다. 대표적인 예로 2002년 7월1일의 독일 위버링겐 상공 공중충돌사고로 두 기체 탑승자 71명 전원 사망하였다. 또한 지상에서 활주로를 이동하는 비행기들 사이에 충돌사고도 간혹 발생한다. 최근 들어 드론 등 무인 항공기의 사용이 빈번해 지면서 드론과 여객기 혹은 드론과 헬리콥터 사이의 충돌사고도 빈번하게 발생하고 있다 (예: 2017년 10월 16일 캐나다 퀘백, 드론/여객기 충돌사고). 이와 같이 비행체들이나 선박들 사이의 근접상황(conflict 또는 conjunction) 또는 충돌(collision)을 정확히 예측하지 못하면 대규모 인명피해로 연결 될 수 있다.Similar to many casualties caused by traffic accidents on land, collisions frequently occur between ships and many casualties occur. In addition, collisions often occur between aircraft, resulting in very high death rates. A typical example was the air collision in Germany over Uberlingen on July 1, 2002, killing all 71 passengers. There are also occasional collisions between planes moving on the runway from the ground. In recent years, the use of drones such as drones has become frequent, resulting in frequent collisions between drones and airliners or drones and helicopters (e.g., Quebec, Canada, drone / passenger collisions on October 16, 2017). As such, failure to accurately predict collisions or collisions between aircraft or vessels can lead to massive casualties.
다수의 이동체들간의 충돌 및 근접관계를 예측하는 방법은 일정한 시간간격으로 한 쌍씩 물체들의 위치를 샘플링하고, 샘플링된 위치들끼리 교차여부를 확인하는 방법이 사용되었다. 그러나 이러한 방법은 샘플링된 방법 및 빈도수에 따라 실제 근접위험이 존재함에도 불구하고 이를 감지하지 못할 위험이 항상 존재하고, 이러한 위험성을 감소시키기 위해서는 계산량이 급격히 증가할 수 밖에 없다. 예를 들어 N개의 이동체들에 대해 샘플링 횟수를 M이라 할 경우, 기존 방법의 계산양은 O(N2M2)이 요구된다. 이 때, 샘플링의 빈도수를 조금만 늘여도 계산량이 급격히 증가하므로, 이동체들의 충돌 및 근접관계의 예측에 대규모 슈퍼컴퓨터가 요구된다.As a method of predicting collision and proximity between a plurality of moving objects, a method of sampling the positions of objects in pairs at regular time intervals and checking whether the sampled positions intersect are used. However, this method has a risk of not detecting it even though there is a real proximity risk depending on the sampling method and frequency, and the amount of calculation must increase rapidly to reduce the risk. For example, when the number of sampling is M for N moving objects, the calculation amount of the conventional method is O (N 2 M 2 ). At this time, even if the frequency of sampling is slightly increased, the amount of calculation increases rapidly. Therefore, a large-scale supercomputer is required for the prediction of collision and proximity of moving objects.
이와 같은 초보적인 방법을 개선하여 정렬된 이진트리에 기반한 Segment Tree [Bentley JL, Wood D. An optimal worst case algorithm for reporting intersections of rectangles. IEEE Transactions on Computers. 1980 Jul 1(7):571-7.]를 이용하여 두 개의 이동체의 충돌을 효율적으로 판단하는 방법도 있다(이진트리를 만들기 위한 O(N log N) 시간과 가장 인접한 두 개의 이동체를 찾기 위한 평균적인 시간 O(log N)시간). 하지만 이 방법은 두 이동체 사이의 충돌에 대해서만 특화되어 있으며 좌표시스템에 의존적이다. Segment Tree [Bentley JL, Wood D. An optimal worst case algorithm for reporting intersections of rectangles. IEEE Transactions on Computers. 1980 Jul 1 (7): 571-7.] Is an efficient way to determine the collision of two moving objects (O (N log N) time to create a binary tree and to find the two nearest moving objects). Average time O (log N) hours). However, this method is specialized only for collisions between two moving bodies and depends on the coordinate system.
반면에 본 발명에서 제안하는 방법은 좌표시스템에 독립적인 방법으로 두 개나 세 개뿐 아니라 임의의 숫자의 이동체들의 근접관계의 분석을 가장 효율적으로 수행할 수 있다 (충돌 및 근접관계 예측을 위한 전처리(preprocessing)에 대한 O(N log N) 시간과 이후 각 이벤트 처리를 위한 평균 O(log N) 시간).On the other hand, the method proposed in the present invention is a method independent of the coordinate system, and can efficiently analyze the proximity of two or three as well as any number of moving objects (preprocessing for collision and proximity prediction). O (N log N) time for) and the average O (log N) time for each subsequent event processing).
또한, 본 발명에서 제안하는 방법을 이용하면 충돌 및 근접관계의 예측을 위한 계산이 완료된 후에도 충돌회피 및 기타 분석을 위해서 이벤트이력(event history)을 통해서 충돌 및 근접관계의 상황에 대한 재현(replay)이 가능하지만 위 방법을 통해서는 재현하기 어렵다. 신속한 재현성은 미래의 상황에 대해 다양한 분석을 반복하여 수행할 수 있다는 측면에서 매우 중요한 기능이다. In addition, the method proposed in the present invention replays the situation of the collision and proximity through the event history for collision avoidance and other analysis even after the calculation for prediction of the collision and proximity is completed. This is possible but difficult to reproduce through the above method. Rapid reproducibility is an important feature in that you can repeat various analyzes for future situations.
또한, 각 이동체들의 크기를 고려하지 않은 경우 즉, 움직이는 점집합에 대한 보로노이다어그램을 계산하는 방법에 대한 연구가 있었다 [Roos T. Voronoi diagrams over dynamic scenes. Discrete Applied Mathematics. 1993 Jun 10;43(3):243-59.]. 하지만 이 방법은 이동체의 크기가 정확하게 반영될 수 없기 때문에 충돌 및 근접관계를 정확하게 예측하기 어려운 한계가 있다.In addition, there has been a study on how to calculate the Voronoid diagram for the moving point set without considering the size of each moving object [Roos T. Voronoi diagrams over dynamic scenes. Discrete Applied Mathematics. 1993 Jun 10; 43 (3): 243-59.]. However, this method is difficult to accurately predict the collision and proximity because the size of the moving body can not be accurately reflected.
본 발명은 적은 양의 계산으로 선형으로 이동하는 다수의 이동체들의 충돌 및 근접관계를 예측하고 회피할 수 있는 방법을 제공한다.The present invention provides a method for predicting and avoiding collisions and proximity of multiple moving bodies moving linearly with a small amount of calculation.
또한, 본 발명은 비선형으로 이동하는 다수의 이동체들의 움직임을 여러 개의 선형 이동으로 근사화하여 다수의 이동체들의 충돌 및 근접관계를 예측하고 회피할 수 있는 방법을 제공한다.In addition, the present invention provides a method for predicting and avoiding collisions and proximity of a plurality of moving bodies by approximating the movement of a plurality of moving bodies moving in a nonlinear manner to a plurality of linear movements.
또한, 본 발명은 이동체들의 충돌 및 근접관계 여부를 놓치지 않고 정확하게 판단할 수 있는 방법을 제공한다.In addition, the present invention provides a method for accurately determining the collision and proximity of the moving objects without missing.
본 발명에 따른 다수의 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 방법은 복수의 이동체들 각각의 형상을 모델링하여 오브젝트들을 생성하는 단계; 상기 오브젝트들의 크기 정보로부터 상기 오브젝트들을 모델링하여 2차원 원을 생성하는 단계; 상기 이동체들의 이동속도와 상기 이동체들의 모니터링 시간 구간, 그리고 상기 2차원 원들의 크기 정보 중 적어도 어느 하나의 이용으로 상기 2차원 원들을 이동 디스크들로 모델링하는 단계; 상기 이동 디스크들 간에 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 모서리들을 산출하는 단계; 및 상기 이동체들의 모니터링 시간 구간 동안, 상기 보로노이 다이어그램의 모서리들 중 적어도 어느 하나가 꼭지점을 거쳐 다시 모서리로 전환되는 플리핑 이벤트와, 상기 보로노이 다이어그램의 모서리를 정의하는 한 쌍의 이동 디스크들 간에 충돌을 예측하는 충돌 이벤트를 계산하고, 상기 플리핑 이벤트와 상기 충돌 이벤트의 발생시간이 빠른 순으로 상기 플리핑 이벤트를 발생시키는 이동 디스크들 간에, 그리고 상기 충돌 이벤트를 발생시키는 이동 디스크들 간에 실제 충돌여부를 계산하는 단계를 포함한다.According to an aspect of the present invention, there is provided a method of predicting and avoiding collision and proximity between a plurality of moving objects, the method comprising: generating objects by modeling a shape of each of the plurality of moving objects; Modeling the objects from the size information of the objects to generate a two-dimensional circle; Modeling the two-dimensional circles as moving disks by using at least one of a moving speed of the moving bodies, a monitoring time interval of the moving bodies, and size information of the two-dimensional circles; Calculating corners of the Voronoi diagram by computing a Voronoi diagram between the moving disks; And a flipping event in which at least one of the corners of the Voronoi diagram is converted back to the corner via a vertex during the monitoring time interval of the moving bodies, and between a pair of moving disks defining the corner of the Voronoi diagram. Calculate a collision event predicting a collision, and between the mobile disks generating the flipping event in the order of occurrence of the flipping event and the collision event in ascending order, and the mobile disk generating the collision event. Calculating whether or not.
또한, 상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트하는 단계를 더 포함하되, 상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는 상기 플리핑 이벤트가 발생되는 보로노이 다이어그램의 모서리 및 이와 연결된 다른 보로노이 다이어그램의 모서리들을 정의하는 이동 디스크들에 대해 보로노이 다이어그램을 재정의하고, 상기 플리핑 이벤트가 발생되는 보로노이 다이어그램의 모서리 및 이와 연결된 다른 보로노이 다이어그램의 모서리들에 대해 플리핑 이벤트의 발생 시간을 재계산하고, 상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리를 정의하는 한 쌍의 이동 디스크들 간에 충돌 이벤트의 발생 시간을 재계산하고, 재계산된 플리핑 이벤트와 충돌 이벤트의 발생시간이 빠른 순으로 플리핑 이벤트를 발생시키는 이동 디스크들 간에, 그리고 충돌 이벤트를 발생시키는 이동 디스크들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되, 상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보 업데이트는 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 플리핑 이벤트와 충돌 이벤트가 모두 발생되지 않을 경우 종료될 수 있다.The method may further include updating information of the Voronoi diagram in which the flipping event is generated, wherein updating the information of the Voronoi diagram in which the flipping event is generated is an edge of the Voronoi diagram in which the flipping event is generated. And redefining the Voronoi diagram for moving disks defining the edges of other Voronoi diagrams connected thereto, and flipping the edges of the Voronoi diagram where the flipping event is generated and the edges of other Voronoi diagrams connected thereto. Recalculate the occurrence time of the event, recalculate the occurrence time of the collision event between a pair of moving disks defining an edge of the Voronoi diagram in which the flipping event occurred, and recalculate the flipped event and the collision event. Fleeing order Recalculating the actual collision between the moving disks generating an event and the moving disks generating a collision event, wherein updating of information of the Voronoi diagram in which the flipping event is generated is monitored by the moving objects. The process is repeated during the time interval and may be terminated when neither the flipping event nor the collision event occurs.
또한, 상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트하는 단계를 더 포함하되, 상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는, 상기 충돌 이벤트를 발생시키는 한 쌍의 이동 디스크들, 그리고 상기 한 쌍의 이동 디스크들과 보로노이 다이어그램의 모서리들을 정의하는 다른 이동 디스크들 서로 간에 충돌 이벤트의 발생 시간을 재계산하고, 상기 충돌 이벤트를 발생시키는 한 쌍의 이동 디스크들이 정의하는 보로노이 다이어그램의 모서리, 그리고 상기 한 쌍의 이동 디스크들과 다른 이동 디스크들이 정의하는 보로노이 다이어그램의 모서리들, 그리고 상기 다른 이동 디스크들이 정의하는 보로노이 다이어그램의 모서리들에 대해 플리핑 이벤트 발생 시간을 재계산하고, 재계산된 충돌 이벤트와 플리핑 이벤트의 발생시간이 빠른 순으로 충돌 이벤트를 발생시키는 이동 디스크들 간에, 그리고 플리핑 이벤트를 발생시키는 이동 디스크들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되, 상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트는 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 플리핑 이벤트와 충돌 이벤트가 모두 발생되지 않을 경우 종료될 수 있다.The method may further include updating information of the Voronoi diagram in which the collision event has occurred, wherein updating of the information of the Voronoi diagram in which the collision event has occurred may include: a pair of mobile disks generating the collision event; And a Voronoi diagram defined by the pair of moving disks and the pair of moving disks generating the collision event, recalculating the occurrence time of a collision event between each of the pair of moving disks and the other moving disks defining the corners of the Voronoi diagram. Recalculate the time of occurrence of a flipping event on the edge of the edge and the corners of the Voronoi diagram defined by the pair of movable disks and the other movable disks, and the corners of the Voronoi diagram defined by the other movable disks. , Recalculated collision events and flipping And recalculating the actual collision between the mobile disks generating the collision event in the order of rapid occurrence of the event and between the mobile disks generating the flipping event, wherein the collision event has occurred. The updating of the information in the diagram is repeated during the monitoring time interval of the moving objects, and may be terminated when neither the flipping event nor the collision event occurs.
또한, 상기 2차원 원을 생성하는 단계는 상기 오브젝트들 각각을 외접하는 외접원을 생성할 수 있다.In addition, the generating of the two-dimensional circle may generate a circumscribed circle that circumscribes each of the objects.
또한, 상기 이동 디스크들을 생성하는 단계는 수학식 1에 의해 상기 이동 디스크들의 반경을 결정할 수 있다.In addition, the generating of the moving disks may determine the radius of the moving disks by the equation (1).
[수학식 1][Equation 1]
R = r +Vmax·tp + δR = r + V max t p + δ
(여기서, R은 이동 디스크들의 반경, r은 2차원 원의 반경, Vmax는 이동체의 최대 속도, tp는 이동체들의 충돌 및 근접관계의 예측을 위한 계산시간, δ는 안전계수)(Where R is the radius of the moving disk, r is the radius of the two-dimensional circle, V max is the maximum velocity of the moving object, t p is the calculation time for the prediction of collision and proximity of the moving bodies, δ is the safety factor)
또한, 상기 이동 디스크들 간에 실제 충돌여부를 계산하는 단계는 상기 이동 디스크들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계를 더 포함할 수 있다.The calculating of the actual collision between the movable disks may further include determining whether the objects of the movable disks collide with each other.
또한, 상기 이동 디스크들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계는, 상기 오브젝트들 각각에 내접하는 복수 개의 내접원들로 상기 오브젝트들을 모델링하고, 상기 내접원 단위로 상기 이동체들의 충돌을 판단할 수 있다.The determining of whether the objects of the moving disks collide with each other may include modeling the objects with a plurality of inscribed circles inscribed in each of the objects, and determining the collision of the movable bodies in units of the inscribed circle.
또한, 상기 이동 디스크들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계는, 상기 이동체들의 방향전환 위치 및 각도를 알고 있는 경우, 상기 방향전환 위치 및 각도에서 방향전환된 오브젝트들을 포함하는 기하학적 형상으로 상기 오브젝트들을 모델링하고, 상기 기하학정 형상들간의 충돌을 판단할 수 있다.The determining of whether the objects of the moving disks collide with each other may include: when the direction and position of the moving body are known, the object having a geometric shape including the objects that are turned at the direction and position of the moving object. Modeling and collision between the geometries.
또한, 상기 이동체들은 각각의 궤도를 따라 이동하며, 상기 이동 디스크들 간에 실제 충돌여부를 계산하는 단계는 상기 보로노이 다이어그램의 모서리에 가장 인접한 상기 이동 디스크들을 충돌 예상 물체들로 추출하고, 상기 충돌 예상 물체들의 이동속도를 분석하여 상기 충돌 예상 물체들의 충돌 여부를 판단할 수 있다.In addition, the moving bodies move along each trajectory, and calculating the actual collision between the moving disks extracts the moving disks closest to the edge of the Voronoi diagram as collision prediction objects, and predicts the collision. By analyzing the moving speed of the objects it is possible to determine whether the collision prediction objects.
또한, 상기 이동 디스크들 간에 실제 충돌여부를 계산하는 단계는, 상기 충돌 예상 물체들 중 제1 충돌 예상 물체(A)와 제2 충돌 예상 물체(B)의 반경이 각각 rA, rB이고, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)의 제1 기준 시점에서의 중심점 위치가 각각 (Ax, Ay), (Bx, By)이고, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)가 상기 궤도를 따라 이동하는 속도가 각각 VA=(vx, vy), UB=(ux, uy) 일 때, t 시간 경과 후 상기 제1 충돌 예상 물체(A)의 예상 위치를 A(t), 상기 제2 충돌 예상 물체(B)의 예상 위치를 B(t)라 할 경우, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)의 충돌 여부는 하기 수학식 2를 통해 연산될 수 있다.In the calculating of the actual collision between the moving disks, the radiuses of the first collision prediction object A and the second collision prediction object B among the collision prediction objects are r A and r B , respectively. The position of the center point at the first reference time point of the first collision prediction object A and the second collision prediction object B is (A x , A y ), (B x , B y ), respectively, and the first When the velocity at which the collision predicted object A and the second collision predicted object B move along the trajectory is V A = (v x , v y ) and U B = (u x , u y ), When the estimated position of the first collision predicted object A is t (t) and the expected position of the second collision predicted object B is t (t) after a time elapses, the first collision predicted object ( Whether A) collides with the second collision predicting object B may be calculated through Equation 2 below.
[수학식 2][Equation 2]
(rx는 Ax-Bx, ry는 Ay-By, wx는 vx-ux, wy는 vy-uy)(r x is A x -B x , r y is A y -B y , w x is v x -u x , w y is v y -u y )
본 발명의 다른 실시 예에 따른 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 방법은 복수의 이동체들 각각의 형상을 모델링하여 오브젝트들을 생성하는 단계; 상기 오브젝트들의 크기 정보로부터 상기 오브젝트들을 3차원 구들로 모델링하는 단계; 상기 이동체들의 이동속도와 상기 이동체들의 모니터링 시간 구간, 그리고 상기 3차원 구들의 크기 정보 중 적어도 어느 하나의 이용으로 상기 3차원 구들을 모델링하여 이동 구들을 생성하는 단계; 상기 이동 구들 간의 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 면과 모서리, 그리고 꼭지점을 산출하는 단계; 및 상기 이동체들의 모니터링 시간 구간 동안, 상기 보로노이 다이어그램의 모서리가 보로노이 다이어그램의 면으로 전환되는 모서리 플리핑 이벤트와, 상기 보로노이 다이어그램의 면이 보로노이 다이어그램의 모서리로 전환되는 면 플리핑 이벤트와, 상기 보로노이 다이어그램의 면을 정의하는 한 쌍의 이동 구들 간에 충돌을 예측하는 충돌 이벤트를 계산하고, 상기 모서리 플리핑 이벤트, 상기 면 플리핑 이벤트, 그리고 상기 충돌 이벤트의 발생시간이 빠른 순으로 상기 모서리 플리핑 이벤트를 발생시키는 이동 구들간에, 상기 면 플리핑 이벤트를 발생시키는 이동 구들 간에, 그리고 상기 상기 충돌 이벤트를 발생시키는 이동 구들 간에 실제 충돌여부를 계산하는 단계를 포함한다.According to another embodiment of the present invention, a method of predicting and avoiding collision and proximity between moving bodies includes: generating objects by modeling shapes of each of the moving bodies; Modeling the objects into three-dimensional spheres from the size information of the objects; Generating moving spheres by modeling the three-dimensional spheres using at least one of a moving speed of the moving bodies, a monitoring time interval of the moving bodies, and size information of the three-dimensional spheres; Calculating a plane, an edge, and a vertex of the Voronoi diagram by computing a Voronoi diagram between the moving spheres; And an edge flipping event in which an edge of the Voronoi diagram is switched to a face of the Voronoi diagram during the monitoring time interval of the moving objects, and a face flipping event in which a face of the Voronoi diagram is turned into an edge of the Voronoi diagram. Computing a collision event for predicting a collision between a pair of moving spheres defining the face of the Voronoi diagram, and the occurrence time of the edge flipping event, the face flipping event, and the collision event in the order of Calculating an actual collision between moving spheres generating an edge flipping event, between moving spheres generating the face flipping event, and between moving spheres generating the collision event.
또한, 상기 모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트 하는 단계를 더 포함하되, 상기 모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는, 상기 모서리 플리핑 이벤트가 발생된 이후의 보로노이 다이어그램의 면과, 이를 구성하는 꼭지점들과 맞닿은 보로노이 다이어그램의 모서리들을 정의하는 상기 이동 구들에 대해 보로노이 다이어그램을 재정의하고, 상기 꼭지점들과 맞닿은 보로노이 다이어그램의 모서리들에 대해 모서리 플리핑 이벤트의 발생을 재계산하고, 상기 모서리 플리핑 이벤트가 발생된 이후의 보로노이 다이어그램의 면에 대해 면 플리핑 이벤트의 발생을 재계산하고, 상기 모서리 플리핑 이벤트 발생의 재계산 이후에 생성된 보노로이 다이어그램의 면을 정의하는 상기 이동 구들간에 충돌 이벤트의 발생을 재계산하고, 재계산된 모서리 플리핑 이벤트와 면 플리핑 이벤트와, 충돌 이벤트의 발생시간이 빠른 순으로, 재계산된 모서리 플리핑 이벤트를 발생시키는 이동 구들 간에, 재계산된 면 플리핑 이벤트를 발생시키는 이동 구들 간에, 그리고 재계산된 충돌 이벤트를 발생시키는 이동 구들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되, 상기 모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는, 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 상기 모서리 플리핑 이벤트와 상기 면 플리핑 이벤트와 상기 충돌 이벤트가 모두 발생되지 않을 경우 종료될 수 있다.The method may further include updating information of the Voronoi diagram in which the edge flipping event is generated, wherein updating the information of the Voronoi diagram in which the edge flipping event occurs is generated after the edge flipping event occurs. Redefine the Voronoi diagram for the face of the Voronoi diagram and the moving spheres defining the corners of the Voronoi diagram that abut the vertices, and the edges of the Voronoi diagram that abuts the vertices. Recalculate the occurrence of the ripping event, recalculate the occurrence of the face flipping event for the face of the Voronoi diagram after the edge flipping event is generated, and generate the recalculation of the edge flipping event occurrence. The moving sphere defining the face of the bonoroy diagram Recalculate the occurrence of collision events between the recomputation, and between the recomputed edge flipping and face flipping events and the moving spheres that generate the recomputed edge flipping events in the order of occurrence of the collision events in ascending order. And recalculating the actual collision between the moving spheres generating the generated surface flipping event and the moving spheres generating the recalculated collision event, wherein the information of the Voronoi diagram in which the corner flipping event is generated. The update of may be repeated during the monitoring time interval of the moving objects, and may be terminated when neither the edge flipping event, the face flipping event, or the collision event occurs.
또한, 상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트 하는 단계를 더 포함하되, 상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는, 상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리 및 이와 연결되는 보로노이 다이어그램의 모서리를 정의하는 상기 이동 구들에 대해 보로노이 다이어그램을 재정의하고, 상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리 및 이와 연결되는 보로노이 다이어그램의 모서리에 대해 모서리 플리핑 이벤트의 발생을 재계산하고, 상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리와 연결된 보로노이 다이어그램의 면들에 대해 면 플리핑 이벤트의 발생을 재계산하고, 상기 모서리 플리핑 이벤트 발생의 재계산 이후에 생성된 보노로이 다이어그램의 면을 정의하는 상기 이동 구들간에 충돌 이벤트의 발생을 재계산하고, 재계산된 모서리 플리핑 이벤트와 면 플리핑 이벤트와, 충돌 이벤트의 발생시간이 빠른 순으로, 재계산된 모서리 플리핑 이벤트를 발생시키는 이동 구들 간에, 재계산된 면 플리핑 이벤트를 발생시키는 이동 구들 간에, 그리고 재계산된 충돌 이벤트를 발생시키는 이동 구들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되, 상기 모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트 는, 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 상기 모서리 플리핑 이벤트와 상기 면 플리핑 이벤트와 상기 충돌 이벤트가 모두 발생되지 않을 경우 종료될 수 있다.The method may further include updating information of the Voronoi diagram in which the plane flipping event is generated, wherein updating the information of the Voronoi diagram in which the plane flipping event is generated comprises: Redefine the Voronoi diagram for the moving spheres that define the edges of the noi diagram and the edges of the Voronoi diagram that is connected to it, the edge of the Voronoi diagram where the face flipping event occurred, and the edge of the Voronoi diagram connected to it. Recalculate the occurrence of an edge flipping event for, recalculate the occurrence of a face flipping event for the faces of the Voronoi diagram associated with the edge of the Voronoi diagram from which the face flipping event occurred, and Bono generated after recalculation of event occurrence Recalculate the occurrence of collision events between the moving spheres that define the faces of the Roy diagram, recalculate edge flipping and face flipping events, and then recalculate edges in ascending order of collision events. Recalculating the actual collision between the moving spheres generating an event, the moving spheres generating a recalculated plane flipping event, and the moving spheres generating a recalculated collision event, wherein The update of the information of the Voronoi diagram in which the ripping event is generated may be repeated during the monitoring time interval of the moving objects and may be terminated when neither the edge flipping event, the face flipping event, or the collision event occurs.
또한, 상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트 하는 단계를 더 포함하되, 상기 충돌 이벤트를 발생시키는 한 쌍의 이동 구들, 그리고 상기 한 쌍의 이동 구들과 보로노이 다이어그램의 면들을 정의하는 다른 이동 구들에 대해 충돌 이벤트 발생을 재계산하고, 상기 한 쌍의 이동 구들과 상기 다른 이동 구들에 의해 정의되는 상기 보로노이 다이어그램의 면들에 포함되는 보로노이 다이어그램의 꼭지점들과 맞닿는 보로노이 다이어그램의 면 또는 보로노이 다이어그램의 모서리에 대해 모서리 플리핑 이벤트와 면 플리핑 이벤트 발생을 재계산하고, 재계산된 충돌 이벤트와 모서리 플리핑 이벤트와, 면 플리핑 이벤트의 발생시간이 빠른 순으로, 재계산된 충돌 이벤트를 발생시키는 이동 구들 간에, 재계산된 모서리 플리핑 이벤트를 발생시키는 이동 구들 간에, 그리고 재계산된 면 이벤트를 발생시키는 이동 구들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되, 상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는, 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 상기 모서리 플리핑 이벤트와 상기 면 플리핑 이벤트와 상기 충돌 이벤트가 모두 발생되지 않을 경우 종료될 수 있다.The method may further include updating information of the Voronoi diagram in which the collision event has occurred, wherein the pair of moving spheres generate the collision event and define the pair of moving spheres and planes of the Voronoi diagram. A face of a Voronoi diagram that recalculates the occurrence of a collision event for other moving spheres and abuts vertices of the Voronoi diagram included in the faces of the Voronoi diagram defined by the pair of moving spheres and the other moving spheres. Or recalculate the edge flipping and face flipping event occurrences for the edges of the Voronoi diagram, and recalculate the recalculated collision events, the edge flipping event, and the occurrence times of the face flipping events in ascending order. Between the moving spheres that generate a collision event, the recalculated edge flipping Recalculating the actual collision between the moving spheres generating the trajectory and the moving spheres generating the recalculated plane event, wherein the updating of the information in the Voronoi diagram in which the collision event occurred has occurred. They are repeated during the monitoring time interval, and may end when neither the edge flipping event, the face flipping event, nor the collision event occurs.
또한, 상기 3차원 구를 생성하는 단계는 상기 오브젝트들 각각을 외접하는 구를 생성할 수 있다.The generating of the 3D sphere may generate a sphere that circumscribes each of the objects.
또한, 상기 이동 구들을 생성하는 단계는 수학식 1에 의해 상기 이동 구들의 반경을 결정할 수 있다.In addition, generating the moving spheres may determine the radius of the moving spheres by the equation (1).
[수학식 1][Equation 1]
R = r +Vmax·tp + δR = r + V max t p + δ
(여기서, R은 이동 구들의 반경, r은 3차원 구의 반경, Vmax는 이동체의 최대 속도, tp는 이동체들의 충돌 및 근접관계의 예측을 위한 계산시간, δ는 안전계수)(Where R is the radius of the moving sphere, r is the radius of the three-dimensional sphere, V max is the maximum velocity of the moving object, t p is the calculation time for the prediction of collision and proximity of the moving bodies, δ is the safety factor)
또한, 상기 이동 구들간에 실제 충돌여부를 계산하는 단계는, 상기 이동 구들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계를 더 포함할 수 있다.The calculating of the actual collision between the moving spheres may further include determining whether the objects of the moving spheres collide with each other.
또한, 상기 이동 구들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계는, 상기 오브젝트들 각각에 내접하는 복수 개의 내접 구들로 상기 오브젝트들을 모델링하고, 상기 내접 구 단위로 상기 이동체들의 충돌을 예측할 수 있다.The determining of whether the objects of the moving spheres collide may be performed by modeling the objects with a plurality of inscribed spheres inscribed in each of the objects, and predicting collision of the moving bodies in units of the inscribed spheres.
또한, 상기 이동 구들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계는, 상기 이동체들의 방향전환 위치 및 각도를 알고 있는 경우, 상기 방향전환 위치 및 각도에서 방향전환된 상기 오브젝트들을 포함하는 기하학적 형상으로 상기 오브젝트들을 모델링하고, 상기 기하학정 형상들의 충돌을 예측할 수 있다.The determining of whether the objects of the moving spheres collide with each other includes: knowing the turning position and angle of the moving bodies, the geometric shape including the turning objects at the turning position and angle. Model objects and predict collisions of geometries.
또한, 상기 이동체들은 각각의 궤도를 따라 이동하며, 상기 이동 구들 간에 실제 충돌 여부를 계산하는 단계는, 상기 보로노이 다이어그램의 면에 가장 인접한 상기 구들을 충돌 예상 물체들로 추출하고, 상기 충돌 예상 물체들의 이동 속도를 분석하여 상기 충돌 예상 물체들의 충돌 여부를 판단할 수 있다.In addition, the moving objects move along each trajectory, and calculating the actual collision between the moving spheres, extracting the spheres closest to the plane of the Voronoi diagram as collision prediction objects, the collision prediction object By analyzing the moving speed of the collision can determine whether the collision of the predicted objects.
또한, 상기 이동 구들의 궤도를 n개의 직선 구간으로 근사화하여 제1 근사 궤도를 생성하고, 상기 이동 구들의 궤도와 상기 제1 근사 궤도 간의 오차를 반영하여 상기 이동 구들의 크기를 1차 보정하고, 크기가 1차 보정된 이동 구들 간의 충돌 여부를 판단하는 이동 구들의 1차 충돌 여부 판단 단계; 및 상기 이동 구들의 1차 충돌 여부 판단 단계에서 상기 크기가 1차 보정된 이동 구들 간에 충돌이 발생될 경우, 상기 이동 구들의 궤도를 상기 n개보다 큰 m개의 직선 구간으로 근사화하여 제 2 근사 궤도를 생성하고, 상기 이동 구들의 궤도와 상기 제2 근사 궤도 간의 오차를 반영하여 상기 이동 구들의 크기를 2차 보정하고, 크기가 2차 보정된 이동 구들 간의 충돌 여부를 판단하는 이동 구들의 2차 충돌 여부 판단 단계를 포함하되, 상기 이동 구들의 1차 충돌 여부 판단 단계 및 상기 이동 구들의 2차 충돌 여부 판단 단계 각각은, 크기가 보정된 이동 구들 간의 다이어그램을 연산하여 보로노이 다이어그램의 면들을 산출하는 보로노이 다이어그램의 면 산출 단계; 상기 크기가 보정된 이동 구들 중 상기 보로노이 다이어그램의 면과 가장 인접한 이동 구들을 충돌 예상 물체들로 추출하는 충돌 예상 물체 추출 단계; 및 상기 충돌 예상 물체들의 이동 속도를 분석하여 충돌 여부를 판단하는 충돌 여부 판단 단계를 포함할 수 있다.또한, 상기 이동 구들 간에 실제 충돌 여부를 계산하는 단계는, 상기 충돌 예상 물체들 중 제1 충돌 예상 물체(A)와 제2 충돌 예상 물체(B)의 반경이 각각 rA, rB이고, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)의 제1 기준 시점에서의 중심점 위치가 각각 (Ax, Ay, Az), (Bx, By, Bz)이고, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)가 상기 궤도를 따라 이동하는 속도가 각각 VA=(vx, vy, vz), UB=(ux, uy, uz) 일 때, t 시간 경과 후 상기 제1 충돌 예상 물체(A)의 예상 위치를 A(t), 상기 제2 충돌 예상 물체(B)의 예상 위치를 B(t)라 할 경우, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)의 충돌 여부는 하기 수학식 2를 통해 연산될 수 있다.In addition, the trajectories of the moving spheres are approximated to n straight sections to generate a first approximate trajectory, and the size of the moving spheres is firstly corrected by reflecting an error between the trajectories of the moving spheres and the first approximate trajectory. Determining whether or not the primary spheres collide with each other by determining whether or not collisions between the primary spheres are first corrected in size; And when collisions occur between the moving spheres whose primary size is corrected in the first collision determination step of the moving spheres, by approximating the trajectories of the moving spheres to m linear sections larger than n, to obtain a second approximate trajectory. Generate second, secondly correct the size of the moving spheres by reflecting an error between the trajectory of the moving spheres and the second approximate orbit, and determine whether or not there is a collision between the moving spheres having the second corrected size. And a collision determination step, wherein each of the first and second collision determination steps of the moving spheres and the second collision determination step of the moving spheres are performed by calculating a diagram between the moving spheres whose size is corrected and calculating the planes of the Voronoi diagram. Calculating a plane of the Voronoi diagram; A collision prediction object extraction step of extracting, as collision prediction objects, moving spheres closest to the plane of the Voronoi diagram among the corrected moving spheres; And a collision determination step of determining whether there is a collision by analyzing the moving speeds of the collision prediction objects. The calculating of the collision between the movement spheres may include: a first collision among the collision prediction objects; The radiuses of the predicted object A and the second collision predicted object B are r A and r B , respectively, and at a first reference time point of the first collided predicted object A and the second collided predicted object B, respectively. The center point positions of are (A x , A y , A z ), (B x , B y , B z ), respectively, and the first collision prediction object A and the second collision prediction object B are the orbits. The first collision predicted object A after elapse of time t when the speed of travel along V A = (v x , v y , v z ) and U B = (u x , u y , u z ), respectively When the estimated position of A (t) and the estimated position of the second collision predicted object B are B (t), the first collision predicted object A and the second collision predicted object B Whether there is a conflict Can be computed through (2).
[수학식 2][Equation 2]
(rx는 Ax-Bx, ry는 Ay-By, rz는 Az-Bz, wx는 vx-ux, wy는 vy-uy, wz는 vz-uz)(r x is A x -B x , r y is A y -B y , r z is A z -B z , w x is v x -u x , w y is v y -u y , w z is v z- u z )
또한, 본 발명은 상술한 이동체들 사이의 충돌 예측 및 회피 방법을 실행하기 위한 프로그램을 저장한 컴퓨터로 판독 가능한 기록매체를 포함할 수 있다.The present invention may also include a computer-readable recording medium having stored thereon a program for executing the above-described collision prediction and avoidance method between the moving objects.
본 발명에 의하면, 보로노이 다이어그램의 적용으로 플리핑 이벤트 및 충돌 이벤트를 발생시키는 이동체들만을 대상으로 충돌 및 근접 여부를 판단하므로, 다수의 이동체들의 충돌 및 근접 예측을 위한 계산량이 최소화될 수 있다.According to the present invention, since the collision and proximity are determined only for the moving objects generating the flipping event and the collision event by applying the Voronoi diagram, the calculation amount for the collision and proximity prediction of the plurality of moving objects can be minimized.
또한, 본 발명에 의하면, 2차원 이동체들이 충돌하는 경우 반드시 보로노이 다이어그램의 모서리를 가지게 되고, 3차원 이동체들이 충돌하는 경우 반드시 보로노이 다이어그램의 면을 가지게 되므로, 보로노이 다이어그램의 모서리 (2차원 이동체 사이의 충돌 및 근접예측문제) 혹은 보로노이 다이어그램의 면 (3차원 이동체 사이의 충돌 및 근접예측문제)을 정의하는 물체들을 확인하면 실제충돌을 절대로 놓치지 않고 정확히 예측할 수 있다. In addition, according to the present invention, when the two-dimensional moving objects collide necessarily have the edge of the Voronoi diagram, and when the three-dimensional moving objects collide necessarily have the face of the Voronoi diagram, the edge of the Voronoi diagram (two-dimensional moving body Identifying objects that define collisions and proximity prediction problems or planes of Voronoi diagrams (collisions and proximity prediction problems between three-dimensional moving objects) can accurately predict the actual collision.
또한, 본 발명에 의하면, 세 개의 2차원 이동체가 근접할 경우 이동체들 사이에 보로노이 다이어그램의 꼭지점을 갖게 되고, 2차원에서 네 개 이상의 이동체가 근접할 경우에는 보로노이 다이어그램의 하부구조(substructure)가 정의될 수 있다. 2차원에서 보로노이 다이어그램은 보로노이 다이어그램의 꼭지점, 모서리, 그리고 면(다각형 모양의 영역으로 개방(open)되거나 폐쇄(close)된 영역)으로 구성되는데, 상기 보로노이 다이어그램의 하부구조는 상술한 보로노이 다이어그램의 꼭지점, 모서리, 그리고 면 중 적어도 어느 하나를 포함하는 보로노이다이어그램의 부분집합을 의미한다.Further, according to the present invention, when three two-dimensional moving objects are close to each other, the vertices of the Voronoi diagram are moved between the moving objects, and when four or more moving objects are close to each other in two dimensions, the substructure of the Voronoi diagram is shown. Can be defined. In two dimensions, the Voronoi diagram consists of the vertices, edges, and faces of the Voronoi diagram (areas that are open or closed in a polygonal region), and the substructure of the Voronoi diagram is described above. A subset of Voronoi diagrams that include at least one of the vertices, edges, and faces of a noise diagram.
3차원 이동체의 경우에도 2차원과 유사하게 세 개의 3차원 이동체가 근접할 경우 이동체들 사이에 보로노이 다이어그램의 모서리를 갖게 되고, 3차원에서 네 개의 이동체가 근접할 경우 이동체들 사이에 보로노이 다이어그램의 꼭지점을 갖게 되며, 다섯 개 이상의 이동체가 근접할 경우에도 보로노이 다이어그램의 하부구조 (substructure)가 정의될 수 있다. 3차원에서 보로노이 다이어그램은 보로노이 다이어그램의 꼭지점, 모서리, 면, 그리고 셀(보로노이 다이그램의 면들로 bound된 다면체로 개방(open)되거나 폐쇄(close)될 수 있음)로 구성되는데, 상기 보로노이 다이어그램의 하부구조는 상술한 보로노이 다이어그램의 꼭지점, 모서리, 면, 그리고 셀 중 적어도 어느 하나를 포함하는 보로노이다이어그램의 부분집합을 의미한다.In the case of a three-dimensional moving object, similarly to two-dimensional, when three three-dimensional moving objects are close to each other, they have an edge of the Voronoi diagram between the moving objects. With the vertices of, the substructure of the Voronoi diagram can be defined even when five or more moving bodies are in close proximity. In three dimensions, the Voronoi diagram consists of the vertices, edges, faces, and cells of the Voronoi diagram, which can be opened or closed with a polyhedron bounded by the faces of the Voronoi diagram. The underlying structure of the noise diagram refers to a subset of boronogram diagrams including at least one of the vertices, edges, faces, and cells of the Voronoi diagram described above.
이와 같이 이동체들 사이의 보로노이 다이어그램이 계산되어 있다면 두 이동체 사이의 충돌뿐만 아니라 세 개, 네 개 혹은 그 이상의 이동체들 사이의 근접관계도 정확하고 효율적으로 예측이 가능하다. 그러므로 본 발명에서 제안하는 방법은 두 개나 세 개뿐만 아니라 임의의 숫자의 이동체들의 근접관계의 분석을 가장 효율적으로 수행할 수 있다.In this way, if the Voronoi diagram between the moving bodies is calculated, the collision between two moving bodies as well as the proximity between three, four or more moving bodies can be accurately and efficiently predicted. Therefore, the method proposed in the present invention can perform the analysis of the proximity of two or three as well as any number of moving objects most efficiently.
도 1은 본 발명의 일 실시 예에 따른 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 시스템을 나타내는 도면이다.
도 2 내지 도 4는 이동체 모델링부가 이동체를 모델링하는 방법을 나타내는 도면이다.
도 5는 본 발명의 제1실시예에 다른 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 방법을 나타내는 순서도이다.
도 6은 이동 디스크들 간에 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 모서리들을 산출하는 단계를 나타내는 도면이다.
도 7은 본 발명의 일 실시 예에 따른 플리핑 이벤트를 설명하기 위한 도면이다.
도 8은 본 발명의 실시 예에 따른 충돌 이벤트를 설명하기 위한 도면이다.
도 9는 플리핑 이벤트와 충돌 이벤트 시간의 경과 후, 업데이트되는 보로노이 다이어그램의 정보를 설명하기 위한 도면이다.
도 10은 오브젝트들 간의 충돌 여부를 판단하는 단계를 나타내는 도면이다.
도 11은 본 발명의 제2실시예에 따른 이동체들간의 충돌 및 근접관계의 예측 방법을 나타내는 순서도이다.
도 12는 이동 구들 간에 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 면, 모서리, 그리고 꼭지점을 산출하는 단계를 나타내는 도면이다.
도 13은 본 발명에 따른 모서리 플리핑 이벤트와 면 플리핑 이벤트를 설명하기 위한 도면이다.
도 14는 본 발명의 일 실시 예에 따라 드론의 충돌 및 근접관계를 예측하고, 회피경로를 제공하는 방법을 설명하기 위한 도면이다.
도 15는 본 발명의 다른 실시 예에 따라 드론의 충돌 및 근접관계를 예측하고, 회피경로를 제공하는 방법을 설명하기 위한 도면이다.
도 16은 본 발명의 일 실시예에 따라 이동 경로가 알려져 있는 이동체들의 충돌 및 근접관계를 예측하는 방법을 설명하기 위한 도면이다.
도 17은 이동체들의 충돌 여부를 판단하는 방법을 설명하기 위한 도면이다.
도 18은 본 발명의 다른 실시 예에 따라 이동 경로가 알려져 있는 이동체들의 충돌을 예측하는 방법을 설명하기 위한 순서도이다.
도 19는 도 18에서 설명한 이동 구들의 1차 충돌 여부 판단 단계를 자세하게 설명하기 위한 도면이다.
도 20는 도 18에서 설명한 이동 구들의 2차 충돌 여부 판단 단계를 자세하게 설명하기 위한 도면이다.
도 21은 도 18에서 설명한 이동 구들의 3차 충돌 여부 판단 단계를 자세하게 설명하기 위한 도면이다.1 is a view showing a system for predicting and avoiding collision and proximity between moving bodies according to an embodiment of the present invention.
2 to 4 are diagrams illustrating a method in which the moving object modeling unit models the moving object.
5 is a flowchart illustrating a method of predicting and avoiding collision and proximity between different moving bodies in the first embodiment of the present invention.
6 is a diagram illustrating a step of calculating corners of a Voronoi diagram by calculating a Voronoi diagram between moving disks.
7 is a diagram illustrating a flipping event according to an embodiment of the present invention.
8 is a diagram illustrating a collision event according to an embodiment of the present invention.
FIG. 9 is a diagram for explaining information of a Voronoi diagram updated after elapse of a flipping event and a collision event time.
10 is a diagram illustrating a step of determining whether collisions between objects occur.
11 is a flowchart illustrating a method of predicting collision and proximity between moving bodies according to a second embodiment of the present invention.
12 is a diagram illustrating a step of calculating a plane, an edge, and a vertex of a Voronoi diagram by calculating a Voronoi diagram between moving spheres.
FIG. 13 illustrates an edge flipping event and a face flipping event according to the present invention.
FIG. 14 is a diagram illustrating a method of predicting a collision and proximity of a drone and providing an avoiding path according to an embodiment of the present invention.
FIG. 15 is a diagram for describing a method of predicting a collision and proximity of a drone and providing an avoiding path according to another embodiment of the present invention.
FIG. 16 is a diagram for describing a method of predicting collision and proximity of moving bodies for which a moving path is known according to one embodiment of the present invention.
17 is a diagram for describing a method of determining whether or not a moving object collides with each other.
FIG. 18 is a flowchart illustrating a method of predicting collision of moving objects for which a moving path is known according to another embodiment of the present invention.
19 is a view for explaining in detail the first collision determination step of the moving spheres described in FIG.
20 is a view for explaining in detail the second collision determination step of the moving spheres described in FIG.
FIG. 21 is a diagram for describing a third collision determination step of the moving spheres illustrated in FIG. 18 in detail.
이하, 첨부된 도면들을 참조하여 본 발명의 바람직한 실시 예를 상세히 설명할 것이다. 그러나 본 발명의 기술적 사상은 여기서 설명되는 실시 예에 한정되지 않고 다른 형태로 구체화 될 수도 있다. 오히려, 여기서 소개되는 실시 예는 개시된 내용이 철저하고 완전해질 수 있도록 그리고 당업자에게 본 발명의 사상이 충분히 전달될 수 있도록 하기 위해 제공되는 것이다.Hereinafter, exemplary embodiments of the present invention will be described in detail with reference to the accompanying drawings. However, the technical idea of the present invention is not limited to the exemplary embodiments described herein and may be embodied in other forms. Rather, the embodiments introduced herein are provided to ensure that the disclosed contents are thorough and complete, and that the spirit of the present invention can be sufficiently delivered to those skilled in the art.
본 명세서에서, 어떤 구성요소가 다른 구성요소 상에 있다고 언급되는 경우에 그것은 다른 구성요소 상에 직접 형성될 수 있거나 또는 그들 사이에 제 3의 구성요소가 개재될 수도 있다는 것을 의미한다. 또한, 도면들에 있어서, 막 및 영역들의 두께는 기술적 내용의 효과적인 설명을 위해 과장된 것이다. In the present specification, when a component is mentioned to be on another component, it means that it may be formed directly on the other component or a third component may be interposed therebetween. In addition, in the drawings, the thicknesses of films and regions are exaggerated for effective explanation of technical contents.
또한, 본 명세서의 다양한 실시 예 들에서 제1, 제2, 제3 등의 용어가 다양한 구성요소들을 기술하기 위해서 사용되었지만, 이들 구성요소들이 이 같은 용어들에 의해서 한정되어서는 안 된다. 이들 용어들은 단지 어느 구성요소를 다른 구성요소와 구별시키기 위해서 사용되었을 뿐이다. 따라서, 어느 한 실시 예에 제 1 구성요소로 언급된 것이 다른 실시 예에서는 제 2 구성요소로 언급될 수도 있다. 여기에 설명되고 예시되는 각 실시 예는 그것의 상보적인 실시 예도 포함한다. 또한, 본 명세서에서 '및/또는'은 전후에 나열한 구성요소들 중 적어도 하나를 포함하는 의미로 사용되었다.In addition, in various embodiments of the present specification, terms such as first, second, and third are used to describe various components, but these components should not be limited by these terms. These terms are only used to distinguish one component from another. Thus, what is referred to as a first component in one embodiment may be referred to as a second component in another embodiment. Each embodiment described and illustrated herein also includes its complementary embodiment. In addition, the term 'and / or' is used herein to include at least one of the components listed before and after.
명세서에서 단수의 표현은 문맥상 명백하게 다르게 뜻하지 않는 한 복수의 표현을 포함한다. 또한, "포함하다" 또는 "가지다" 등의 용어는 명세서상에 기재된 특징, 숫자, 단계, 구성요소 또는 이들을 조합한 것이 존재함을 지정하려는 것이지, 하나 또는 그 이상의 다른 특징이나 숫자, 단계, 구성요소 또는 이들을 조합한 것들의 존재 또는 부가 가능성을 배제하는 것으로 이해되어서는 안 된다. 또한, 본 명세서에서 "연결"은 복수의 구성 요소를 간접적으로 연결하는 것, 및 직접적으로 연결하는 것을 모두 포함하는 의미로 사용된다. In the specification, the singular encompasses the plural unless the context clearly indicates otherwise. In addition, the terms "comprise" or "having" are intended to indicate that there is a feature, number, step, element, or combination thereof described in the specification, and one or more other features or numbers, steps, configurations It should not be understood to exclude the possibility of the presence or the addition of elements or combinations thereof. In addition, the term "connection" is used herein to mean both indirectly connecting a plurality of components, and directly connecting.
또한, 하기에서 본 발명을 설명함에 있어 관련된 공지 기능 또는 구성에 대한 구체적인 설명이 본 발명의 요지를 불필요하게 흐릴 수 있다고 판단되는 경우에는 그 상세한 설명은 생략할 것이다.In addition, in the following description of the present invention, if it is determined that a detailed description of a related known function or configuration may unnecessarily obscure the subject matter of the present invention, the detailed description thereof will be omitted.
본 발명은 움직이는 물체(이하, '이동체'라고 함)들 사이의 근접 또는 충돌상황에 의한 위험을 예측하고, 충돌을 회피하기 위한 방법을 제공한다. 이동체는 항공기, 선박, 잠수함, 인공위성, 드론, 자동차 등을 포함하는 모든 고속 또는 저속의 이동체이며 이들의 운행방식은 유인 또는 무인인 경우를 포함한다. 또한, 이동체는 지구 주위를 공전하는 인공위성과 같이 이동 경로가 알려져 있는 물체뿐만 아니라, 항공기, 자율주행 자동차, 드론, 잠수함, 선박 등과 같이 이동 경로가 일정하지 않으나 순간 위치와 이동방향 및 속력을 측정할 수 있는 물체를 포함한다. 이동체의 이동 경로는 선형 경로와 비선형 경로를 포함할 수 있다. 본 발명에 따르면, 비선형 경로는 복수 개의 선형 경로로 근사화될 수 있다. 근사화되는 선형 경로의 개수는 사용자의 설정에 따라 결정되며, 이동체들이 근사화된 선형 경로들을 따라 이동하는 것으로 가정한다. 이동체는 상술한 선형 경로와 근사화된 선형 경로들의 각 구간에서 등속 직선 운동할 수 있다.The present invention provides a method for estimating a danger due to a proximity or collision situation between moving objects (hereinafter referred to as 'moving body') and avoiding a collision. Vehicles are all high speed or low speed vehicles, including aircraft, ships, submarines, satellites, drones, automobiles, etc., and their modes of operation include manned or unmanned. In addition to moving objects such as satellites orbiting around the earth, moving bodies are not only constant in moving paths such as aircraft, autonomous cars, drones, submarines, ships, etc. Contains objects that can be. The moving path of the moving body may include a linear path and a nonlinear path. According to the present invention, the nonlinear path can be approximated into a plurality of linear paths. The number of linear paths to be approximated is determined according to the user's setting, and it is assumed that the moving bodies move along the approximated linear paths. The moving body may move in a constant velocity linear motion in each section of the linear path and the linear paths described above.
본 발명에서는 상술한 이동체간의 충돌을 예측하고 충돌을 회피하기 위해서는 이동체의 동적 데이터(dynamics data)가 필요한데, 동적 데이터는 위성항법시스템(Global Navigation Satellite System, GNSS)을 통해 측정될 수 있으며, 적절한 방법에 의해 수집할 수 있다. In the present invention, in order to predict the collision between the moving objects and to avoid the collision, dynamic data of the moving object is required. The dynamic data may be measured through a global navigation satellite system (GNSS), and an appropriate method. Can be collected by
실시 예에 의하면, 위성항법시스템을 이용하여 측정된 동적 데이터는 이동체의 순간 위치와 이동 속도를 포함하는 정보로, 항공기는 ADS-B(Automatic Dependent Surveillance Broadcast)를 이용하고, 선박은 AIS(Automatic Identification System)을 이용하여 수집할 수 있다. 드론은 와이파이 등의 무선통신기술을 사용하거나, ADS-B를 사용하여 수집할 수 있다. 자율주행 자동차는 차량들 상호간 통신을 가능하게 해 주는 VANET(Vehicular ad hoc network )의 통신링크인 V2X등을 이용하여 수집할 수 있다.According to the embodiment, the dynamic data measured using the satellite navigation system is information including the instantaneous position and the moving speed of the moving object, the aircraft uses the Automatic Dependent Surveillance Broadcast (ADS-B), the vessel is the Automatic Identification Can be collected using System. Drones can be collected using wireless technology, such as Wi-Fi, or by using ADS-B. Autonomous vehicles can be collected using V2X, which is a communication link of a vehicular ad hoc network (VANET) that enables communication between vehicles.
도 1은 본 발명의 일 실시 예에 따른 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 시스템을 나타내는 도면이고, 도 2 내지 도 4는 이동체 모델링부가 이동체를 모델링하는 방법을 나타내는 도면이다. 도 2 내지 도 4는 이해의 편의를 위해 이동체를 2차원으로 표현하였으나, 3차원 공간상에서 동일한 원리로 용이하게 이해될 수 있을 것이다.1 is a diagram illustrating a system for predicting and avoiding collision and proximity between moving bodies according to an exemplary embodiment of the present invention, and FIGS. 2 to 4 are views illustrating a method for modeling a moving body by the moving modeling unit. 2 to 4 represent the moving object in two dimensions for convenience of understanding, it can be easily understood on the same principle in three-dimensional space.
먼저, 도 1을 참조하면, 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 시스템(100)은 이동체 정보 수신부(110), 이동체 모델링부(120), 그리고 충돌 예측부(130)를 포함한다.First, referring to FIG. 1, the
이동체 정보 수신부(110)는 각각의 이동체들로부터 정보를 수신한다. 수신되는 정보에는 이동체의 종류, 형상, 크기, 무게, 이동 경로, 순간 위치, 이동방향 및 속력 등이 포함될 수 있다. 아래에서는 이동체의 이동 경로, 순간 위치, 이동방향 및 속력을 이동체의 동적 데이터라고 칭한다.The moving object
이동체 모델링부(120)는 이동체 정보 수신부(110)로부터 이동체들의 정보를 전달받아 이동체들을 기 설정된 형상으로 모델링한다. 이동체 모델링부(120)는 이동체의 종류에 따라 2차원 또는 3차원으로 모델링할 수 있다. 실시 예에 의하면, 선박과 자동차는 2차원 평면에서 움직임 표현이 가능하므로, 2차원 형상으로 모델링 할 수 있다. 반면, 항공기, 드론, 잠수함, 그리고 인공위성은 3차원 공간에서 움직임 표현이 가능하므로, 3차원 형상으로 모델링 할 수 있다. 물론 선박과 자동차도 3차원 형상으로 모델링 가능하나, 2차원 형상으로 모델링함으로써 데이터 처리량을 감소시킬 수 있다.The moving
도 2를 참조하면, 이동체 모델링부(120)는 이동체(10)들의 형상 정보로부터 이동체(10)들을 모델링하여 2차원 또는 3차원 오브젝트(11)들을 생성할 수 있다. 생성된 오브젝트(11)들은 이동체들의 실제 형상보다 단순화된 기하학적 형상을 갖는다. 실시 예에 의하면, 선박(10)은 타원의 2차원 오브젝트(11)로 모델링 될 수 있다.Referring to FIG. 2, the moving
이동체 모델링부(120)는 생성된 오브젝트(11)들의 크기 정보로부터 오브젝트(11)들을 2차원 원 또는 3차원 구(12)로 모델링 할 수 있다. 실시 예에 의하면, 선박과 자동차의 오브젝트(11)들을 2차원 원(12)으로 모델링할 수 있고, 항공기, 드론, 잠수함, 그리고 인공위성의 오브젝트(11)들을 3차원 구(12)로 모델링할 수 있다. 이동체 모델링부(120)는 오브젝트(11)들을 외접하는 최소 직경의 외접원을 2차원 원(12) 또는 오브젝트(11)들을 외접하는 최소 직경의 외접 구(12)들을 3차원 구로 모델링할 수 있다.The moving
이동체 모델링부(120)는 이동체(10)들의 순간위치 및 이동 속도의 불확실성을 반영하여 상기 2차원 원 또는 상기 3차원 구(12)를 이동 디스크 또는 이동 구(13)로 모델링할 수 있다. 구체적으로, 이동체 모델링부(120)은 이동체(10)들의 이동속도, 이동체(10)들의 모니터링 시간 구간, 그리고 2차원 원 또는 3차원 구(12)들의 크기 정보 중 적어도 어느 하나를 이용하여 이동 디스크 또는 이동 구(13)로 모델링할 수 있다. The moving
실시 예에 의하면, 이동체 모델링부(120)는 2차원 원(12)을 아래 수학식 1을 이용하여 2차원의 이동 디스크(13)로 모델링할 수 있다.According to an embodiment, the moving
[수학식 1][Equation 1]
R = r +Vmax·tp + δR = r + V max t p + δ
(여기서, R은 이동 디스크(13)들의 반경, r은 2차원 원(12)의 반경, Vmax는 이동체(10)의 최대 속도, tp는 이동체(10)들의 충돌 및 근접관계의 예측을 위한 계산시간, δ는 안전계수)(Where R is the radius of the moving
다른 실시 예에 의하면, 이동체 모델링부(120)는 3차원 구(12)를 아래 수학식 2를 이용하여 이동 구(13)로 모델링할 수 있다.According to another embodiment, the moving
[수학식 2][Equation 2]
R = r +Vmax·tp + δR = r + V max t p + δ
(여기서, R은 이동 구(13)들의 반경, r은 3차원 구(13)의 반경, Vmax는 이동체(10)의 최대 속도, tp는 이동체(10)들의 충돌 및 근접관계의 예측을 위한 계산시간, δ는 안전계수)(Where R is the radius of the moving
상술한 내용에서, tp는 충돌 및 근접관계의 예측의 대상이 되는 이동체의 개수를 알아야 하며, 이동체들의 개수가 정해지면 tp가 정해진다. 즉 예측 대상인 이동체의 개수를 알면 예측시간을 구할 수 있다. 이와 달리, 상기 tp는 사용자가 적절한 값을 지정할 수 있다.In the above-described information, and t p is the prediction know the number of the moving object as the object of the collision, and close-up relationship, the number of the moving object is determined when the predetermined t p. That is, the prediction time can be obtained by knowing the number of moving objects to be predicted. Alternatively, t p may be appropriately assigned by the user.
도 3을 참조하면, 이동체 모델링부(120)는 2차원의 오브젝트(12)들을 그 내부에 내접하는 복수 개의 내접원(21 내지 25)들로 모델링 할 수 있다. 구체적으로, 오브젝트(12)들의 경계선은 복수의 경계영역 모서리들과 이들이 만나는 경계영역 꼭지점들로 이루어지는데, 이러한 경계영역 모서리들과 경계영역 꼭지점들에 대해 보로노이 다이어그램을 적용하여 보로노이 다이어그램의 모서리와 이들이 만나는 보로노이 다이어그램의 꼭지점을 생성한다. 그리고 보로노이 다이어그램의 꼭지점들 중 오브젝트들의 경계선과 접하는 원의 반지름이 가장 큰 꼭지점을 선정하고, 이를 중심으로 반경이 가장 큰 제1내접원(21)을 생성한다. 그리고 제1내접원(21) 다음으로 큰 반경을 가지며 제1내접원(21)과 중첩되지 않은 제2내접원(22, 24)을 생성한다. 이러한 순서로, 2차원 오브젝트(12)들은 복수 개의 내접원(21 내지 25)들로 모델링 될 수 있다.Referring to FIG. 3, the moving
이동체 모델링부(120)는 3차원 오브젝트(12)들을 그 내부에 내접하는 복수 개의 내접 구(21 내지 25)들로 모델링 할 수 있다. 이동체 모델링부(120)는 3차원 오브젝트(12)들의 경계영역 데이터를 통해 내부에 내접 구(21 내지 25)들을 모델링 할 수 있다. 구체적으로 3차원 오브젝트(12)들의 경계영역 데이터에 보로노이 다이어그램을 적용하여, 오브젝트들의 경계영역과 접하는 반경이 가장 큰 제1내접 구(21)와, 그 다음으로 큰 반경을 가지며 제1내접 구(21)와 중첩되지 않은 제2내접 구(22, 23)를 생성한다. 이러한 방법으로, 3차원 오브젝트(12)들은 그 내부에 내접하는 복수 개의 내접 구(21 내지 25)들로 모델링 될 수 있다.The moving
도 4를 참조하면, 이동체 모델링부(120)는 비선형 이동경로가 근사화된 선형 이동 경로상에서 이동체의 방향전환 위치 및 각도를 알고 있는 경우, 방향전환 위치 및 각도에서 오브젝트(12)가 방향전환할 수 있는 모든 경우의 수(12, 12a, 12b)를 포함하는 기하학적 형상(14)으로 모델링할 수 있다. 실시 예에 의하면, 선박이 방향을 변경할 경우, 무게 중심(C)을 기준으로 기존 진행방향(V1)에 대해 일정각도 ±θ내에서만 방향전환이 가능하다고 알려져 있다고 가정할 경우, 이동체 모델링부(120)는 기존 진행방향의 오브젝트(12)와 +θ로 방향전환한 오브젝트(12a), 그리고 -θ로 방향전환한 오브젝트(12b)를 모두 포함하는 기하학적 형상(14)으로 오브젝트를 모델링할 수 있다.Referring to FIG. 4, when the moving
또한, 이동체 모델링부(120)는 상기 기하학적 형상(14)들을 내접하는 복수 개의 내접원들 또는 내접 구(미도시)들로 모델링 할 수 있다. 상기 기하학적 형상(14)들을 내접하는 복수 개의 내접원들 또는 내접 구들의 모델링은 도 3에서 설명한 바와 동일하게 진행될 수 있다.In addition, the moving
충돌 예측부(130)는 이동 디스크들 또는 이동 구들간에 보로노이 다이어그램을 연산하여, 이동 디스크들 간에 또는 이동 구들간의 충돌 및 근접관계의 여부를 예측한다. 충돌 예측부(130)는 이동체들의 모니터링 시간 구간(t0, t0 +△t)에서, 이동 디스크들 간에 또는 이동 구들간의 충돌 및 근접관계의 여부를 예측한다.The
제1실시 예에 따르면, 충돌 예측부(130)는 이동 디스크들 간에 보로노이 다이어그램을 계산하여 보로노이 다이어그램의 모서리들을 산출한다. 그리고 충돌 예측부(130)는 플리핑 이벤트(Flipping event)와 충돌 이벤트(Collision event)를 계산한다. 플리핑 이벤트는 보로노이 다이어그램의 모서리들 중 적어도 어느 하나가 꼭지점을 거쳐 다시 모서리로 전환되는 이벤트이고, 충돌 이벤트는 보로노이 다이어그램의 모서리를 정의하는 한 쌍의 이동 디스크들 간에 충돌이 예측되는 이벤트이다. 충돌 예측부(130)는 이동 디스크들의 동적 데이터를 이용하여 보로노이 다이어그램의 모서리를 정의하는 한 쌍의 이동 디스크들이 충돌한다고 예측되는 경우 충돌 이벤트를 생성한다. According to the first embodiment, the
플리핑 이벤트와 충돌 이벤트의 발생은 여러 건일 수 있으며, 충돌 예측부(130)는 플리핑 이벤트와 충돌 이벤트를 발생 시간이 빠른 시간 순서로 스케줄링한다.There may be several occurrences of the flipping event and the collision event, and the
충돌 예측부(130)는 이벤트 발생 시간이 빠른 순서로, 이벤트를 발생시키는 이동 디스크들 간에 실제 충돌 여부를 계산한다. 충돌 예측부(130)는 이동 디스크들의 동적 데이터를 이용하여 충돌 여부를 계산한다. 계산 결과, 실제 충돌이 일어나거나 충돌이 발생되지 않는 것으로 판단될 수 있다. 충돌 예측부(130)는 실제 충돌이 발생되는 것으로 판단될 경우, 충돌 예상 이동 디스크들의 동적 데이터를 수정하여 이동 디스크들간의 충돌을 회피하도록 한다.The
충돌 예측부(130)는 해당 이벤트 시간의 경과 후, 보로노이 다이어그램의 정보를 업데이트 한다. The
구체적으로 충돌 예측부(130)는 플리핑 이벤트가 발생된 후 아래 3가지 정보를 업데이트 할 수 있다. In more detail, the
A-1-1) 충돌 예측부(130)는 상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리 및 이와 연결된 다른 보로노이 다이어그램의 모서리들을 대상으로 위상(topology) 정보를 업데이트한다. 충돌 예측부(130)는 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리 및 이와 연결된 다른 보로노이 다이어그램의 모서리들에 대해 보로노이 다이어그램을 재정의한다.A-1-1) the
A-1-2) 충돌 예측부(130)는 상기 플리핑 이벤트가 발생되는 보로노이 다이어그램의 모서리 및 이와 연결된 다른 보로노이 다이어그램의 모서리들에 대해 플리핑 이벤트의 발생 시간을 재계산한다.A-1-2) the
A-1-3) 충돌 예측부(130)는 상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리를 정의하는 한 쌍의 이동 디스크들 간에 충돌 이벤트의 발생 시간을 재계산한다.A-1-3) the
또한, 충돌 예측부(130)는 충돌 이벤트가 발생된 후 아래 두 가지 정보를 업데이트 할 수 있다. In addition, the
A-2-1) 충돌 예측부(130)는 상기 충돌 이벤트를 발생시키는 한 쌍의 이동 디스크들, 그리고 상기 한 쌍의 이동 디스크들과 보로노이 다이어그램의 모서리들을 정의하는 다른 이동 디스크들 서로 간에 충돌 이벤트 발생 시간을 재계산한다.A-2-1) the
A-2-2) 충돌 예측부(130)는 상기 충돌 이벤트를 발생시키는 한 쌍의 이동 디스크들이 정의하는 보로노이 다이어그램의 모서리, 그리고 상기 한 쌍의 이동 디스크들과 다른 이동 디스크들이 정의하는 보로노이 다이어그램의 모서리들, 그리고 상기 다른 이동 디스크들이 정의하는 보로노이 다이어그램의 모서리들에 대해 플리핑 이벤트 발생 시간을 재계산한다.A-2-2)
충돌 예측부(130)는 상술한 보로노이 다이어그램의 정보의 업데이트 후, 재계산된 플리핑 이벤트와 재계산된 충돌 이벤트를 발생 시간이 빠른 순서로 스케줄링하고, 발생 시간이 빠른 순서로 이벤트를 발생시키는 이동 디스크들 간에 실제 충돌 여부를 계산하고, 실제 충돌이 발생한다고 판단 시 충돌회피를 위해서 이동 디스크들의 동적 데이터를 수정한다.After updating the above information of the Voronoi diagram, the
충돌 예측부(130)는 상술한 플리핑 이벤트와 충돌 이벤트가 발생된 보로노이 다이어그램의 정보 업데이트, 그리고 정보가 업데이트된 이동 디스크들 간의 실제 충돌 여부의 계산 및 충돌 회피 과정을 해당 모니터링 시간 구간(t0, t0 +△t) 동안 순차적으로 반복하며, 이동체들의 모니터링 시간 구간(t0, t0 +△t)이 경과하거나, 해당 모니터링 시간 구간(t0, t0 +△t)에서 플리핑 이벤트와 충돌 이벤트가 둘 다 발견되지 않을 경우, 충돌여부 계산을 종료한다.The
제2실시 예에 따르면, 충돌 예측부(130)는 이동 구들간에 보로노이 다이어그램을 정의하여 보로노이 다이어그램의 면, 모서리, 그리고 꼭지점을 산출한다. 그리고 충돌 예측부(130)는 모서리 플리핑 이벤트(Edge flipping event)와 면 플리핑 이벤트(Face flipping event), 그리고 충돌 이벤트(Collision event)를 계산한다. 모서리 플리핑 이벤트는 보로노이 다이어그램의 모서리가 꼭지점을 거쳐 삼각형 형태의 면으로 전환되는 이벤트이고, 면 플리핑 이벤트는 삼각형 형태의 보로노이 다이어그램의 면이 꼭지점을 거쳐 모서리로 전환되는 이벤트이다. 충돌 이벤트는 삼각형 형태뿐만 아니라 모든 형태의 보로노이 다이어그램의 면을 정의하는 한 쌍의 이동 구들 간에 충돌이 예측되는 이벤트이다. 충돌 예측부(130)는 이동 구들의 동적 데이터를 이용하며, 상기 한 쌍의 이동 구들이 충돌한다고 예측되는 경우 충돌 이벤트를 생성한다.According to the second embodiment, the
모서리 플리핑 이벤트, 면 플리핑 이벤트, 그리고 충돌 이벤트의 발생은 여러 건일 수 있으며, 충돌 예측부(130)는 이벤트 발생 시간이 빠른 시간 순서로 스케줄링한다.An edge flipping event, a face flipping event, and a collision event may be generated several times, and the
충돌 예측부(130)는 이벤트 발생 시간이 빠른 순서로, 이벤트를 발생시키는 이동 구들 간에 실제 충돌 여부를 계산한다. 계산 결과, 실제 충돌이 일어나거나 충돌이 발생되지 않는 것으로 판단될 수 있다. 충돌 예측부(130)는 실제 충돌이 발생되는 것으로 판단될 경우, 충돌 예상 이동 구들의 동적 데이터를 수정하여 충돌을 회피하도록 한다.The
충돌 예측부(130)는 해당 이벤트 시간의 경과 후, 보로노이 다이어그램의 정보를 업데이트 한다. The
구체적으로 충돌 예측부(130)는 모서리 플리핑 이벤트가 발생된 후, 아래 4가지 정보를 업데이트 할 수 있다. In more detail, after the edge flipping event is generated, the
B-1-1) 충돌 예측부(130)는 상기 모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 위상 정보를 업데이트한다. 충돌 예측부(130)는 상기 모서리 플리핑 이벤트가 발생된 이후의 보로노이 다이어그램의 면과, 이를 구성하는 꼭지점들과 맞닿은 보로노이 다이어그램의 모서리들을 정의하는 상기 이동 구들에 대해 보로노이 다이어그램을 재정의한다.B-1-1) the
B-1-2) 충돌 예측부(130)는 상기 모서리 플리핑 이벤트가 발생된 이후의 삼각형 형태의 보로노이 다이어그램의 면을 구성하는 꼭지점들과 맞닿은 보로노이 다이어그램의 모서리들에 대해 모서리 플리핑 이벤트의 발생을 재계산한다. 단, 해당 보로노이 다이어그램의 모서리가 다른 삼각형 형태의 보로노이 다이어그램의 면에 포함되는 경우, 계산 대상에서 제외된다.B-1-2) The
B-1-3) 충돌 예측부(130)는 상기 모서리 플리핑 이벤트의 발생으로 새로 생성된 삼각형 형태의 보로노이 다이어그램의 면에 대해 면 플리핑 이벤트의 발생 시간을 재계산한다. 그리고 상기 삼각형 형태의 보로노이 다이어그램의 면의 꼭지점과 맞닿은 다른 삼각형 형태의 보로노이 다이어그램의 면이 있다면, 이 면에 대해서도 면 플리핑 이벤트의 발생 시간을 재계산한다.B-1-3) the
B-1-4) 위 B-1-2)에서 새로 생성되는 모든 보로노이 다이어그램의 면을 정의하는 이동 구들 간에 충돌 이벤트 발생을 재계산한다. 충돌 이벤트 발생의 재계산은 삼각형 형태의 보로노이 다이어그램의 면뿐만 아니라 다른 형태의 보로노이 다이어그램의 면들을 대상으로 한다.B-1-4) Recalculate collision event occurrence between the moving spheres that define the faces of all newly created Voronoi diagrams in B-1-2) above. Recalculation of collision event occurrences covers not only faces of triangular Voronoi diagrams, but also faces of other forms of Voronoi diagrams.
그리고 충돌 예측부(130)는 면 플리핑 이벤트가 발생된 후, 아래 4가지 정보를 업데이트 할 수 있다. The
B-2-1) 충돌 예측부(130)는 상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 위상 정보를 업데이트한다. 충돌 예측부(130)는 상기 면 플리핑 이벤트가 발생된 이후의 보로노이 다이어그램의 모서리와 맞닿는 보로노이 다이어그램의 모서리들을 정의하는 상기 이동 구들에 대해 보로노이 다이어그램을 재정의한다.B-2-1) the
B-2-2) 충돌 예측부(130)는 상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리 및 이와 연결되는 보로노이 다이어그램의 모서리에 대해 모서리 플리핑 이벤트의 발생을 재계산한다. 단, 해당 보로노이 다이어그램의 모서리가 다른 삼각형 형태의 보로노이 다이어그램의 면에 포함되는 경우, 계산 대상에서 제외된다.B-2-2) The
B-2-3) 충돌 예측부(130)는 상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리와 연결된 보로노이 다이어그램의 면들에 대해 면 플리핑 이벤트의 발생을 재계산한다.B-2-3) The
B-2-4) 충돌 예측부(130)는 위 B-2-2)에 따른 상기 모서리 플리핑 이벤트 발생의 재계산 이후에 생성된 보노로이 다이어그램의 면을 정의하는 상기 이동 구들간에 충돌 이벤트의 발생을 재계산한다.B-2-4) The
또한, 충돌 예측부(130)는 충돌 이벤트가 발생된 후, 아래 2가지 정보를 업데이트 할 수 있다. In addition, the
B-3-1) 충돌 예측부(130)는 상기 충돌 이벤트를 발생시키는 한 쌍의 이동 구들, 그리고 상기 한 쌍의 이동 구들과 보로노이 다이어그램의 면들을 정의하는 다른 이동 구들에 대해 충돌 이벤트 발생을 재계산한다.B-3-1)
B-3-2) 충돌 예측부(130)는 상기 한 쌍의 이동 구들과 상기 다른 이동 구들에 의해 정의되는 상기 보로노이 다이어그램의 면들에 포함되는 보로노이 다이어그램의 꼭지점들과 맞닿는 보로노이 다이어그램의 면 또는 보로노이 다이어그램의 모서리에 대해 모서리 플리핑 이벤트와 면 플리핑 이벤트 발생을 재계산한다.B-3-2) the
충돌 예측부(130)는 위에서 설명한, 재계산된 모서리 플리핑 이벤트와, 면 플리핑 이벤트, 그리고 충돌 이벤트를 발생 시간이 빠른 순서로 스케줄링하고, 발생 시간이 빠른 순서로 이벤트를 발생시키는 이동 구들 간에 실제 충돌 여부를 계산하고, 실제 충돌이 발생되는 것으로 판단될 경우, 충돌 예상 이동 구들의 동적 데이터를 수정하여 충돌을 회피하도록 한다.The
충돌 예측부(130)는 상술한 보로노이 다이어그램의 정보의 업데이트, 그리고 정보가 업데이트된 이동 구들 간의 실제 충돌 여부의 계산, 및 충돌 회피 과정을 이동체들의 모니터링 시간 구간 동안 순차적으로 반복하며, 이동체들의 모니터링 시간 구간이 경과하거나, 해당 시간 구간 동안 모서리 플리핑 이벤트와 면 플리핑 이벤트, 그리고 충돌 이벤트가 모두 발견되지 않을 경우, 이동 구들 간에 실제 충돌예측을 종료한다.The
이하, 상술한 다수의 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 시스템을 이용하여 이동체들 사이의 충돌 및 근접관계를 예측하고 회피하는 방법에 대해 설명한다. 다수의 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 방법은 다수의 이동체들이 2차원으로 모델링되어 충돌을 예측하는 제1실시예와 다수의 이동체들이 3차원으로 모델링되어 충돌을 예측하는 제2실시예로 구분하여 설명한다.Hereinafter, a method of predicting and avoiding collision and proximity between moving objects using a system for predicting and avoiding collision and proximity between a plurality of moving objects will be described. A method of predicting and avoiding collision and proximity between a plurality of moving objects is a first embodiment in which a plurality of moving objects are modeled in two dimensions and predicting a collision, and a second embodiment in which a plurality of moving objects is modeled in three dimensions and predicting a collision. The description will be made with an example.
도 5는 본 발명의 제1실시예에 따른 다수의 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 방법을 나타내는 순서도이다.5 is a flowchart illustrating a method of predicting and avoiding collision and proximity between a plurality of moving objects according to a first embodiment of the present invention.
도 5를 참조하면, 다수의 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 방법은, 복수의 이동체들 각각의 형상을 모델링하여 오브젝트들을 생성하는 단계(S110), 상기 오브젝트들의 크기 정보로부터 상기 오브젝트들을 모델링하여 2차원 원을 생성하는 단계(S120); 상기 이동체들의 이동속도와 상기 이동체들의 모니터링 시간 구간, 그리고 상기 2차원 원들의 크기 정보 중 적어도 어느 하나의 이용으로 상기 2차원 원들을 이동 디스크들로 모델링하는 단계(S130), 상기 이동 디스크들 간에 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 모서리들을 산출하는 단계(S140), 그리고 상기 이동체들의 모니터링 시간 구간 동안, 상기 이동 디스크들간에 실제 충돌여부를 계산하는 단계(S150)를 포함한다.Referring to FIG. 5, in the method of predicting and avoiding collision and proximity between a plurality of moving objects, generating objects by modeling shapes of a plurality of moving objects (S110), the object from the size information of the objects Modeling them to generate a two-dimensional circle (S120); Modeling the two-dimensional circles as moving disks by using at least one of a moving speed of the moving bodies, a monitoring time interval of the moving bodies, and size information of the two-dimensional circles (S130), and between the moving disks. Computing the noise diagram to calculate the corners of the Voronoi diagram (S140), and during the monitoring time interval of the moving object, calculating the actual collision between the moving disk (S150).
도 2 및 도 5을 참조하면, 복수의 이동체(10)들 각각의 형상을 모델링하여 오브젝트(11)들을 생성하는 단계(S110)는, 이동체(10)들의 형상 정보를 통해 오브젝트(11)들을 생성한다.2 and 5, the generating of the
상기 오브젝트(11)들의 크기 정보로부터 상기 오브젝트(11)들을 모델링하여 2차원 원(12)을 생성하는 단계(S120)는 상기 오브젝트(11)들 각각을 외접하는 최소 직경의 2차원 원(12)들을 생성한다.Generating the two-
상기 2차원 원(12)들을 이동 디스크(13)들로 모델링하는 단계(S130)는, 상기 이동체(10)들의 이동속도와 상기 이동체(10)들의 모니터링 시간 구간, 그리고 상기 2차원 원(12)들의 크기 정보 중 적어도 어느 하나의 이용하여 2차원 원(12)들을 이동 디스크(13)들로 모델링한다. 실시 예에 의하면, 상술한 수학식 1을 이용하여 상기 2차원 원(12)들을 상기 이동 디스크들(13)로 모델링할 수 있다.The step S130 of modeling the two-
도 6은 이동 디스크들 간에 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 모서리들을 산출하는 단계를 나타내는 도면이다.6 is a diagram illustrating a step of calculating corners of a Voronoi diagram by calculating a Voronoi diagram between moving disks.
도 5 및 도 6을 참조하면, 상기 이동 디스크들 간에 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 모서리들을 산출하는 단계(S140)는, 복수 개의 이동 디스크(13a 내지 13g)들 간에 보로노이 다이어그램을 연산하고, 보로노이 다이어그램의 모서리(E1, E2, E3, …)들과 꼭지점(V1, V2, …)들을 산출한다. 보로노이 다이어그램의 모서리(E1, E2, E3, …)들은 인접한 한 쌍의 이동 디스크(13a 내지 13g)들 간에 생성되고, 보로노이 다이어그램의 꼭지점(V1, V2, …)은 적어도 세 개의 보로노이 다이어그램의 모서리(E1, E2, E3, …)들이 만나 생성된다.5 and 6, the calculating of the corners of the Voronoi diagram by calculating the Voronoi diagram between the moving disks may include calculating the Voronoi diagram between the plurality of moving
상기 이동 디스크(13a 내지 13g)들 간의 실제 충돌을 계산하는 단계(S150)는, 상기 이동체들의 모니터링 시간 구간 동안, 플리핑 이벤트와 충돌 이벤트 발생을 계산하고, 이벤트 발생 시간이 빠른 순서대로 스케줄링한다.Computing the actual collision between the mobile disk (13a to 13g) (S150), during the monitoring time interval of the moving object, calculates the flipping event and the collision event occurrence, and schedules the event occurrence time in the order of rapidity.
도 7은 본 발명의 일 실시 예에 따른 플리핑 이벤트를 설명하기 위한 도면이다.7 is a diagram illustrating a flipping event according to an embodiment of the present invention.
먼저 도 7의 (A)를 참조하면, 제1시점(t0)에서 두 개의 이동 디스크(13b, 13c)에 의해 보로노이 다이어그램의 모서리(E2)가 생성된다. (B)를 참조하면, 보로노이 다이어그램의 모서리(E2)는 이동 디스크(13a)의 이동에 따라 제2시점(t0<t1<t0+△t)에서 꼭지점(Vf)으로 전환된다. (C)를 참조하면, 보로노이 다이어그램의 꼭지점(Vf)은 이동 디스크(13a)의 이동에 따라 제3시점(t1<t2< t0+△t)에서 다시 모서리(E4)로 전환된다. 이처럼, 이동 디스크(13a)의 이동에 따라 보로노이 다이어그램의 모서리(E2)가 꼭지점(Vf)을 거쳐 다시 모서리(E4)로 전환되는 플리핑 이벤트가 발생된다.First, referring to FIG. 7A, the edge E2 of the Voronoi diagram is generated by the two moving
도 8은 본 발명의 실시 예에 따른 충돌 이벤트를 설명하기 위한 도면이다.8 is a diagram illustrating a collision event according to an embodiment of the present invention.
도 8의 (A)를 참조하면, 제1시점(t0)에서 한 쌍의 이동 디스크(13a, 13c)에 의해 보로노이 다이어그램의 모서리(E2)가 생성된다. (B)를 참조하면, 한 쌍의 이동 디스크(13a, 13c)의 동적 데이터에 따라 제2시점(t0<t1<t0+△t)에서 두 개의 이동 디스크(13a, 13c)의 충돌이 예측되어 충돌 이벤트가 발생된다.Referring to FIG. 8A, the edge E2 of the Voronoi diagram is generated by the pair of moving
도면에는 한 개의 플리핑 이벤트와 충돌 이벤트가 발생한 것으로 도시하였지만, 이동 디스크들의 개수와 동적 데이터에 따라 플리핑 이벤트와 충돌 이벤트는 동시에 또는 시계열로 여러 개 발생할 수 있다.Although one flipping event and a collision event are shown in the figure, a plurality of flipping events and a collision event may occur simultaneously or in time series according to the number of moving disks and dynamic data.
상기 이동 디스크(13a, 13c)들 간의 실제 충돌을 계산하는 단계는 이벤트 발생 시간이 빠른 순서대로 해당 이벤트를 발생시키는 이동 디스크(13a, 13c)들의 충돌 여부를 계산한다. 충돌 여부의 계산은 이동 디스크(13a, 13c)들의 동적 데이터를 이용하며, 실제 충돌이 일어나거나 충돌이 발생되지 않는 것으로 판단될 수 있다. 충돌이 발생되는 것으로 판단될 경우, 충돌 예상 디스크들(13a, 13c)의 동적 데이터를 수정하여 충돌을 회피하도록 한다.The step of calculating the actual collision between the
도 9는 플리핑 이벤트와 충돌 이벤트 시간의 경과 후, 업데이트되는 보로노이 다이어그램의 정보를 설명하기 위한 도면이다. FIG. 9 is a diagram for explaining information of a Voronoi diagram updated after elapse of a flipping event and a collision event time.
도 9의 (A)를 참조하면, 플리핑 이벤트 시간의 경과 후 업데이트되는 보로노이 다이어그램의 정보는 상술한 A-1-1) 내지 A-1-3)와 동일하다. Referring to FIG. 9A, the information of the Voronoi diagram updated after the elapse of the flipping event time is the same as the above-described A-1-1) to A-1-3).
구체적으로, 플리핑 이벤트 시간의 경과에 따라 해당 이벤트가 발생된 보로노이 다이어그램의 모서리(E4) 및 이와 연결된 다른 보로노이 다이어그램의 모서리(E1, E3, E5, E6)들에 대해 위상정보를 업데이트한다.Specifically, the phase information is updated with respect to the edge E4 of the Voronoi diagram in which the corresponding event is generated and the edges E1, E3, E5, and E6 of the other Voronoi diagram connected to the flipping event. .
그리고 보로노이 다이어그램의 모서리(E4) 및 이와 연결된 다른 보로노이 다이어그램의 모서리(E1, E3, E5, E6)에 대해 플리핑 이벤트 발생 시간을 재계산한다.The time of occurrence of the flipping event is recalculated for the edge E4 of the Voronoi diagram and the edges E1, E3, E5, and E6 of the other Voronoi diagram connected thereto.
또한, 보로노이 다이어그램의 모서리(E4)에 대해 한 쌍의 이동 디스크(13a, 13d)들 간의 충돌 이벤트 발생 시간을 재계산한다.In addition, the time of occurrence of the collision event between the pair of moving
도 9의 (B)를 참조하면, 충돌 이벤트 시간의 경과 후 업데이트되는 보로노이 다이어그램의 정보는 상술한 A-2-1) 및 A-2-2)와 동일하다. 구체적으로, 충돌 이벤트 시간의 경과에 따라서, 보로노이 다이어그램의 모서리(E2) 및 해당 보로노이 다이어그램의 모서리(E2)를 정의하는 이동 디스크(13a, 13c)들이 다른 디스크(13b, 13d 내지 13f)들과 함께 정의하는 보로노이 다이어그램의 모서리들(E1, E3 내지 E7)에 대해 이동 디스크(13a 내지 13f)들 간의 충돌 이벤트 발생 시간을 재계산한다.Referring to FIG. 9B, the information of the Voronoi diagram updated after the collision event time elapses is the same as the above-described A-2-1) and A-2-2). Specifically, as the collision event time elapses, the moving
그리고 보로노이 다이어그램의 모서리(E2) 및 해당 보로노이 다이어그램의 모서리(E2)를 정의하는 이동 디스크(13a, 13c)들이 다른 디스크(13b, 13d 내지 13f)들과 함께 정의하는 보로노이 다이어그램의 모서리들(E1, E3 내지 E7), 그리고 이들과 연결된 또 다른 보로노이 다이어그램의 모서리(E8, E9, E10, E11)들에 대해 플리핑 이벤트 발생 시간을 재계산한다.And the edges of the Voronoi diagram defined by the moving
상기 이동 디스크들 간의 실제 충돌을 계산하는 단계(S150)는, 상술한 보로노이 다이어그램의 정보의 업데이트 후, 재계산된 플리핑 이벤트와 재계산된 충돌 이벤트를 발생 시간이 빠른 순서로 스케줄링하고, 발생 시간이 빠른 순서로 이벤트를 발생시키는 이동 디스크들 간에 실제 충돌 여부를 계산하고, 실제 충돌이 발생한다고 판단 시 충돌회피를 위해서 이동 디스크들의 동적 데이터를 수정한다.Computing the actual collision between the mobile disk (S150), after updating the information of the Voronoi diagram described above, scheduling the re-calculated flipping event and the re-calculated collision event in the order of occurrence time, It calculates the actual collision between the moving disks that generate the events in the fast order, and when it determines that the actual collision occurs, the dynamic data of the moving disks are corrected to avoid the collision.
그리고 상기 이동 디스크들 간의 실제 충돌을 계산하는 단계(S150)는, 상술한 플리핑 이벤트와 충돌 이벤트가 발생된 보로노이 다이어그램의 정보 업데이트, 그리고 정보가 업데이트된 이동 디스크들 간의 실제 충돌 여부의 계산 및 충돌 회피 과정을 해당 모니터링 시간 구간(t0, t0 +△t) 동안 순차적으로 반복되며, 이동체들의 모니터링 시간 구간(t0, t0 +△t)이 경과하거나, 해당 모니터링 시간 구간(t0, t0 +△t)에서 플리핑 이벤트와 충돌 이벤트가 둘 다 발견되지 않을 경우, 충돌여부 계산을 종료한다.The calculating of the actual collision between the mobile disks (S150) may include: updating the information of the Voronoi diagram in which the above-mentioned flipping event and the collision event have occurred, and calculating whether or not the actual collision between the mobile disks with updated information is performed; the monitoring time period for collision avoidance process (t 0, t 0 + △ t) sequentially and repeatedly, the moving object monitoring time period of (t 0, t 0 + △ t) has elapsed, or the monitoring time interval (t 0 for If no flipping event or collision event is found at t 0 + Δt), the collision calculation is terminated.
한편, 다수의 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 방법은 상술한 이벤트를 발생시키는 이동 디스크(13a 내지 13d)들 간에 실제 충돌이 계산되는 경우, 충돌이 예측되는 이동 디스크(13a 내지 13d)들의 오브젝트들이 충돌하는지 여부를 판단하는 단계를 더 포함한다. 오브젝트들 간의 충돌 여부 판단으로, 이동체가 실제 충돌할 가능성을 검증한다.On the other hand, the method of predicting and avoiding collisions and proximity between a plurality of moving objects is a moving
일 실시 예에 따른 오브젝트들 간의 충돌 여부를 판단하는 단계는, 이동체들의 모니터링 시간 동안, 이동 디스크들 각각의 이동 방향 및 이동 속도로부터 오브젝트들이 실제 충돌하는지 여부를 계산한다.The determining of the collision between the objects according to an embodiment of the present disclosure calculates whether the objects actually collide from the moving direction and the moving speed of each of the moving disks during the monitoring time of the moving objects.
도 10은 오브젝트들 간의 충돌 여부를 판단하는 단계를 나타내는 도면이다. 도 10을 참조하면, 오브젝트들 간의 충돌 여부를 판단하는 단계는, 도 3에서 설명한 방법으로 오브젝트(12a)들 각각에 내접하는 복수 개의 내접원(21a 내지 25a)들로 오브젝트(12a)들을 모델링하고, 내접원(21a 내지 25a) 단위로 충돌 여부를 계산한다. 내접원(21a 내지 25a) 단위로 충돌 여부의 판단은, 이동체의 이동 방향 및 이동 속도(V1)를 내접원(21a 내지 25a)들 각각에 적용하여 내접원(21a 내지 25a)들의 이동 경로를 예상하고, 다른 이동체의 이동 정보(V2)에 따른 오브젝트(12b) 및 그의 내접원(21b 내지 25b)들의 이동 경로를 예상하여 두 오브젝트(12a, 12b)의 내접원(21a 내지 25a, 21b 내지 25b)들간의 충돌 여부를 판단한다. 하나의 오브젝트(12a)를 구성하는 내접원(21a 내지 25a)들 중 어느 하나가 다른 하나의 오브젝트(12b)를 구성하는 내접원(21b 내지 25b)과 충돌할 경우, 양 오브젝트간(12a, 12b)에 충돌이 발생하는 것으로 예측할 수 있다.10 is a diagram illustrating a step of determining whether collisions between objects occur. Referring to FIG. 10, the method of determining whether or not the objects collide with each other may include modeling the
또 다른 실시 예에 따른 오브젝트들 간의 충돌 여부를 판단하는 단계는, 비선형 이동경로가 근사화된 선형 이동 경로상에서 이동체의 방향전환 위치 및 각도를 알고 있는 경우, 도 4에서 설명한 내용과 동일하게 방향전환 위치 및 각도 내에서 오브젝트가 방향전환할 수 있는 모든 경우의 수를 포함하는 기하학적 형상으로 오브젝트를 모델링하고, 이동체의 이동 방향 및 이동 속도를 기하학적 형상들에 적용하여 기하학적 형상들의 충돌 여부를 계산할 수 있다.The determining of the collision between the objects according to another embodiment may include the same as described with reference to FIG. 4, when the position and angle of the moving object are known on the linear moving path in which the nonlinear moving path is approximated. And modeling the object with a geometric shape including the number of cases in which the object can be redirected within an angle, and calculating the collision of the geometric shapes by applying the moving direction and the moving speed of the moving object to the geometric shapes.
또한, 상기 기하학적 형상들 각각에 내접하는 복수 개의 내접원들로 기하학적 형상들을 모델링하고, 내접원 단위로 기하학적 형상들의 충돌 여부를 계산할 수 있다.In addition, the geometric shapes may be modeled by a plurality of inscribed circles inscribed in each of the geometric shapes, and the collisions of the geometric shapes may be calculated based on the inscribed circle.
도 11은 본 발명의 제2실시예에 따른 다수의 이동체들간의 충돌 및 근접관계의 예측 및 회피 방법을 나타내는 순서도이다.11 is a flowchart illustrating a method for predicting and avoiding collision and proximity between a plurality of moving objects according to a second embodiment of the present invention.
도 11을 참조하면, 다수의 이동체들간의 충돌 및 근접관계의 예측 및 회피 방법은, 복수의 이동체들 각각의 형상을 모델링하여 오브젝트들을 생성하는 단계(S210), 상기 오브젝트들의 크기 정보로부터 상기 오브젝트들을 모델링하여 3차원 구를 생성하는 단계(S220), 상기 이동체들의 이동속도와 상기 이동체들의 모니터링 시간 구간, 그리고 상기 3차원 구들의 크기 정보 중 적어도 어느 하나의 이용으로 상기 3차원 구들을 이동 구들로 모델링하는 단계(S230), 상기 이동 구들 간에 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 면들과 모서리들, 그리고 꼭지점들을 산출하는 단계(S240), 그리고 상기 이동체들의 모니터링 시간 구간 동안, 상기 이동 구들 간의 실제 충돌을 계산하는 단계(S250)를 포함한다. Referring to FIG. 11, in the method of predicting and avoiding collision and proximity between a plurality of moving objects, generating objects by modeling shapes of each of the plurality of moving objects (S210), and detecting the objects from the size information of the objects. Generating a 3D sphere by modeling (S220), modeling the 3D spheres as moving spheres using at least one of moving speeds of the moving bodies, a monitoring time interval of the moving bodies, and size information of the 3D spheres. (S230), calculating a Voronoi diagram between the moving spheres, calculating faces, edges, and vertices of the Voronoi diagram (S240), and during the monitoring time interval of the moving bodies, actual collisions between the moving spheres. Comprising a step (S250).
복수의 이동체들 각각의 형상을 모델링하여 오브젝트들을 생성하는 단계(S210)는, 이동체들의 형상 정보를 통해 오브젝트들을 생성한다. Generating objects by modeling shapes of each of the plurality of moving objects (S210) generates objects through shape information of the moving objects.
상기 오브젝트들의 크기 정보로부터 상기 오브젝트들을 모델링하여 3차원 구를 생성하는 단계(S220)는 상기 오브젝트들 각각을 외접하는 최소 직경의 3차원 외접구들을 생성한다.Generating the three-dimensional sphere by modeling the objects from the size information of the object (S220) generates a three-dimensional circumferential sphere of the minimum diameter circumscribe each of the objects.
상기 3차원 구들을 이동 구들로 모델링하는 단계(S230)는, 상기 이동체들의 이동속도와 상기 이동체들의 모니터링 시간 구간, 그리고 상기 3차원 구들의 크기 정보 중 적어도 어느 하나의 이용하여 3차원 구들을 이동 구들로 모델링한다. 실시 예에 의하면, 상술한 수학식 2을 이용하여 상기 3차원 구들을 상기 이동 구들로 모델링한다.The modeling of the three-dimensional spheres as moving spheres (S230) may include moving spheres of the three-dimensional spheres using at least one of a moving speed of the moving bodies, a monitoring time interval of the moving bodies, and size information of the three-dimensional spheres. Model with. According to an embodiment, the three-dimensional spheres are modeled as the moving spheres using Equation 2 described above.
상기 이동 구들 간에 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 면들과 모서리들, 그리고 꼭지점들을 산출하는 단계(S240)는 도 12와 같이, 복수 개의 이동 구(S1 내지 S5)들 간에 보로노이 다이어그램을 연산하고, 보로노이 다이어그램의 면(P1, P2, …)들과 모서리(E1 내지 E7)들, 그리고 꼭지점(V1, V2)들을 산출한다. 보로노이 다이어그램의 면(P1, P2, …)들은 인접한 두 개의 이동 구(S1 내지 S5)들 간에 생성되고, 보로노이 다이어그램의 모서리(E1 내지 E7)들은 적어도 두 개의 보로노이 다이어그램의 면(P1, P2, …)들이 만나 생성되고, 보로노이 다이어그램의 꼭지점(V1, V2)은 적어도 세 개의 보로노이 다이어그램의 모서리(E1 내지 E7)들이 만나 생성된다.Computing the Voronoi diagram between the moving spheres and calculating the faces, the edges, and the vertices of the Voronoi diagram (S240), as shown in FIG. 12, calculates the Voronoi diagram between the plurality of moving spheres S1 to S5. The surfaces P1, P2, ..., the edges E1 to E7, and the vertices V1 and V2 of the Voronoi diagram are calculated. The faces P1, P2,... Of the Voronoi diagram are created between two adjacent moving spheres S1-S5, and the edges E1-E7 of the Voronoi diagram have a face P1, at least two of the Voronoi diagrams. P2,... Are met and generated, and vertices V1, V2 of the Voronoi diagram are generated by meeting at least three edges E1-E7 of the Voronoi diagram.
상기 이동 구들 간의 실제 충돌을 계산하는 단계(S250)는, 상기 이동체들의 모니터링 시간 구간 동안, 모서리 플리핑 이벤트, 면 플리핑 이벤트, 그리고 충돌 이벤트의 발생을 계산하고 이벤트 발생 시간이 빠른 순서대로 스케줄링한다.Computing the actual collision between the moving spheres (S250), during the monitoring time interval of the moving object, calculates the occurrence of the corner flipping event, the plane flipping event, and the collision event and schedules the event occurrence time in the order of rapidity .
도 13은 본 발명에 따른 모서리 플리핑 이벤트와 면 플리핑 이벤트를 설명하기 위한 도면이다.FIG. 13 illustrates an edge flipping event and a face flipping event according to the present invention.
먼저 도 13의 (A)를 참조하면, 제1시점(t0)에서 세 개의 보로노이 다이어그램의 면들에 의해 보로노이 다이어그램의 모서리(E1)가 생성된다. (B)를 참조하면, 보로노이 다이어그램의 모서리(E1)는 이동 구(S1 내지 S5)들의 이동에 따라 제2시점(t0<t1<t0 +△t)에서 꼭지점(Vf)으로 전환된다. (C)를 참조하면, 보로노이 다이어그램의 꼭지점(Vf)은 이동 구(S1 내지 S5)들의 이동에 따라 제3시점(t1<t2<t0 +△t)에서 삼각형 형태의 면(P3)으로 전환된다. First, referring to FIG. 13A, the edge E1 of the Voronoi diagram is generated by the planes of the three Voronoi diagrams at the first time point t 0 . Referring to (B), the edge E1 of the Voronoi diagram moves from the second time point t 0 <t 1 <t 0 + Δt to the vertex V f as the movement spheres S1 to S5 move. Is switched. Referring to (C), the vertex V f of the Voronoi diagram is a triangular plane (T 1 <t 2 <t 0 + Δt) at the third time point (t 1 <t 2 <t 0 + Δt) according to the movement of the moving spheres S1 to S5. Switch to P3).
이와 반대로, 제1시점(t0)에서 이동 구(S1 내지 S5)들은 삼각형 형태의 보로노이 다이어그램의 면(P3)을 형성하고(도면 C), 이동 구(S1 내지 S5)들의 이동에 따라 제2시점(t0<t1<t0 +△t)에서 보로노이 다이어그램의 면(P3)이 꼭지점(Vf)으로 전환되고(도면 B), 이동 구(S1 내지 S5)들의 이동에 따라 제3시점(t1<t2<t0 +△t)에서 보로노이 다이어그램의 모서리(E1)과 이를 포함하는 보로노이 다이어그램의 면을 생성할 수 있다(도면 A)On the contrary, at the first time point t 0 , the moving spheres S1 to S5 form a plane P3 of the Voronoi diagram in the form of a triangle (FIG. At 2 o'clock (t 0 <t 1 <t 0 + Δt), the plane P3 of the Voronoi diagram is converted to the vertex V f (Fig. B), and the motion spheres S1 to S5 are moved according to the movement of the moving spheres S1 to S5. At three views (t 1 <t 2 <t 0 + Δt), an edge E1 of the Voronoi diagram and a face of the Voronoi diagram including the same may be generated (Fig. A).
상술한 바와 같이, 보로노이 다이어그램의 모서리(E1)가 꼭지점(Vf)을 거쳐 삼각형 형태의 면(P3)으로 전환되는 과정은 모서리 플리핑 이벤트로 정의하고, 삼각형 형태의 보로노이 다이어그램의 면(P3)이 꼭지점(Vf)을 거쳐 모서리(E1)으로 전환되는 과정은 면 플리핑 이벤트로 정의할 수 있다.As described above, the process of converting the edge E1 of the Voronoi diagram into the triangular plane P3 through the vertex V f is defined as an edge flipping event, and the plane of the triangular Voronoi diagram ( The process of converting P3) to the edge E1 through the vertex V f may be defined as a face flipping event.
도면에는 한 개의 플리핑 이벤트가 발생한 것으로 도시하였지만, 이동 구들(S1 내지 S5)의 개수와 동적 데이터에 따라 플리핑 이벤트는 동시에 또는 시계열로 여러 개 발생할 수 있다.Although one flipping event is shown in the figure, the number of flipping events may occur simultaneously or in time series according to the number of moving spheres S1 to S5 and the dynamic data.
상기 이동 구들간의 실제 충돌을 계산하는 단계(S250)는 이벤트 시간이 빠른 순서대로 해당 이벤트를 발생시키는 이동 구들(S1 내지 S5)들의 실제 충돌 여부를 계산한다. 충돌 여부의 계산은 이동 구(S1 내지 S5)들의 동적 데이터를 이용하며, 실제 충돌이 발생하거나 충돌이 발생되지 않는 것으로 판단될 수 있다. 충돌이 발생되는 것으로 판단될 경우, 충돌 예상 이동 구들의 동적 데이터를 수정하여 이동 구들의 충돌을 회피하도록 한다.Calculating the actual collision between the moving spheres (S250) calculates whether or not the actual collision of the moving spheres (S1 to S5) that generates the event in the order of the event time is fast. The calculation of the collision uses dynamic data of the moving spheres S1 to S5, and it may be determined that an actual collision does not occur or a collision does not occur. If it is determined that a collision occurs, the dynamic data of the collision prediction moving spheres is modified to avoid collision of the moving spheres.
상기 이동 구들 간의 실제 충돌을 계산하는 단계는 해당 이벤트 시간의 경과 후, 보로노이 다이어그램의 정보를 업데이트 한다. The step of calculating the actual collision between the moving spheres updates the information of the Voronoi diagram after the elapse of the corresponding event time.
모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는 상술한 B-1-1) 내지 B-1-4)의 내용으로 진행되고, 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는 상술한 B-2-1) 내지 B-2-4)의 내용으로 진행되고, 그리고 충돌 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는 상술한 B-3-1) 및 B-3-2)의 내용으로 진행된다.The update of the information of the Voronoi diagram in which the edge flipping event is generated proceeds to the contents of B-1-1) to B-1-4) described above, and the update of the information of the Voronoi diagram in which the face flipping event is generated. Is proceeded to the contents of the above B-2-1) to B-2-4), and the update of the information of the Voronoi diagram in which the collision event occurred is described in the above B-3-1) and B-3-2. Proceeds to).
상기 이동 구들간의 실제 충돌을 계산하는 단계(S250)는 위에서 설명한, 재계산된 모서리 플리핑 이벤트와, 면 플리핑 이벤트, 그리고 충돌 이벤트를 발생 시간이 빠른 순서로 스케줄링하고, 발생 시간이 빠른 순서로 이벤트를 발생시키는 이동 구들 간에 실제 충돌 여부를 계산하고, 실제 충돌이 발생되는 것으로 판단될 경우, 충돌 예상 이동 구들의 동적 데이터를 수정하여 충돌을 회피하도록 한다.Calculating the actual collision between the moving spheres (S250) is to schedule the re-calculated corner flipping event, the surface flipping event, and the collision event described above in the order of occurrence time, Calculate whether there is an actual collision between the moving spheres generating the event, and if it is determined that the actual collision occurs, modify the dynamic data of the collision predicted moving spheres to avoid the collision.
그리고 상기 이동 구들간의 실제 충돌을 계산하는 단계(S250)는 상술한 보로노이 다이어그램의 정보의 업데이트, 그리고 정보가 업데이트된 이동 구들 간의 실제 충돌 여부의 계산, 및 충돌 회피 과정을 이동체들의 모니터링 시간 구간 동안 순차적으로 반복하며, 이동체들의 모니터링 시간 구간이 경과하거나, 해당 시간 구간 동안 모서리 플리핑 이벤트와 면 플리핑 이벤트, 그리고 충돌 이벤트가 모두 발견되지 않을 경우, 이동 구들 간에 실제 충돌예측을 종료한다.The calculating of the actual collision between the moving spheres (S250) includes updating the information on the Voronoi diagram described above, calculating whether or not the actual collision between the updated spheres is updated, and avoiding collision during the monitoring time interval of the moving objects. When the monitoring time interval of the moving objects elapses, or when no edge flipping event, a face flipping event, and a collision event are not found during the corresponding time interval, the actual collision prediction between the moving spheres is terminated.
한편, 다수의 이동체들 사이의 충돌 및 근접관계의 예측 및 회피 방법은, 이벤트를 발생시키는 이동 구들 간에 충돌이 예측되는 경우, 충돌이 예측되는 이동 구들의 오브젝트들이 충돌하는지 여부를 판단하는 단계를 더 포함한다. 오브젝트들 간의 충돌 여부 판단으로, 이동체가 실제 충돌할 가능성을 검증한다.On the other hand, the method of predicting and avoiding collision and proximity between a plurality of moving objects, when collision is predicted between the moving spheres generating an event, determining whether the objects of the moving spheres that are predicted to collide further collide. Include. By determining whether the objects collide with each other, the possibility of the actual collision of the moving object is verified.
일 실시 예에 따른 오브젝트들 간의 충돌 여부를 판단하는 단계는, 이동체들의 모니터링 시간 동안, 이동 구들 각각의 이동 방향 및 이동 속도로부터 오브젝트들이 실제 충돌하는지 여부를 계산한다.The determining of the collision between the objects according to an embodiment of the present disclosure calculates whether the objects actually collide from the moving direction and the moving speed of each of the moving spheres during the monitoring time of the moving objects.
다른 실시 예에 따른 오브젝트들 간의 충돌 여부를 판단하는 단계는, 오브젝트들 각각에 내접하는 복수 개의 내접 구들로 오브젝트들을 모델링하고, 내접 구 단위로 충돌 여부를 계산한다. 내접 구들로 오브젝트들을 모델링하는 방법은 도 3에서 설명한 과정으로 진행될 수 있다. 내접 구 단위로 충돌 여부의 판단은 도 8에서 설명한 내용과 동일하게, 이동체의 이동 방향 및 이동 속도를 내접 구들 각각에 적용하여 내접 구들의 이동 경로를 예상하고, 예상된 경로에서 다른 오브젝트의 내접 구들과 충돌 여부를 판단한다. 하나의 오브젝트를 구성하는 내접 구들 중 어느 하나가 다른 하나의 오브젝트를 구성하는 내접 구와 충돌할 경우, 양 오브젝트간에 충돌이 발생하는 것으로 예측할 수 있다.In the determining of whether the objects collide with each other according to an embodiment of the present disclosure, the objects are modeled using a plurality of inscribed spheres inscribed in each of the objects, and the collision is calculated in units of inscribed spheres. The method of modeling objects with indirect spheres may proceed to the process described with reference to FIG. 3. The determination of whether the collision is in the unit of the inscribed sphere is the same as described in FIG. 8, by applying the moving direction and the moving speed of the moving object to each of the inscribed spheres to predict the inscribed paths of the inscribed spheres, and inscribed spheres of other objects in the expected path. To determine whether or not When any one of the inscribed spheres constituting one object collides with the inscribed spheres constituting the other object, it can be predicted that a collision occurs between both objects.
또 다른 실시 예에 따른 오브젝트들 간의 충돌 여부를 판단하는 단계(S260)는, 비선형 이동경로가 근사화된 선형 이동 경로상에서 이동체의 방향전환 위치 및 각도를 알고 있는 경우, 도 4에서 설명한 내용과 동일하게 방향전환 위치 및 각도에서 오브젝트가 방향전환할 수 있는 모든 경우의 수를 포함하는 기하학적 형상으로 오브젝트를 모델링하고, 이동체의 이동 방향 및 이동 속도를 기하학적 형상들에 적용하여 기하학적 형상들의 충돌 여부를 계산할 수 있다.In the determining of whether the objects collide with each other according to another embodiment (S260), when the non-linear movement path knows the redirection position and angle of the moving object on the approximated linear movement path, the same as described with reference to FIG. 4. The object can be modeled with a geometric shape that includes the number of cases the object can turn at the turning position and angle, and the collision direction can be calculated by applying the moving direction and the moving speed of the moving object to the geometric shapes. have.
또한, 상기 기하학적 형상들 각각에 내접하는 복수 개의 내접 구들로 기하학적 형상들을 모델링하고, 내접 구 단위로 기하학적 형상들의 충돌 여부를 계산할 수 있다.In addition, the geometric shapes may be modeled using a plurality of inscribed spheres inscribed in each of the geometric shapes, and the collision of geometric shapes may be calculated in units of inscribed spheres.
상술한 복수의 이동체 중에서 특정 2대가 ?t시간 후에 근접/충돌한다고 예측이 되었을 때 이를 회피하기 위해서는 그 중 한 대 또는 모두의 이동경로의 식을 수정해서 충돌을 회피해야 한다. 여기서 이동경로의 식은 이동경로와 이동경로 내에서 시간에 따른 속도의 크기까지도 포함한다. 따라서 이동경로의 식을 수정하는 방법은 이동경로와 이동속도 중 하나만 또는 이동경로와 이동속도 모두를 변경하는 방법이 있을 수 있다. 이 때 이동경로와 이동속도는 비선형을 포함할 수 있다. 많은 이동체가 움직이고 있고 또 임의의 시간에 임의의 이동체가 이동경로의 식을 수정할 수 있는 상황에서 가장 안전한 회피경로를 찾는 회피경로 최적 설계 방법은 다양한 후보 해를 만든 후 각각을 신속하게 평가해서 그 중 가장 유리한 해를 선택하는 것이다. 본 발명의 대상이 되는 이동체들은 회피기동을 위해서 사용하는 에너지(연료, 배터리 등)를 최소화하는 것이 중요한 문제이다. 예를 들어, 인공위성의 경우 회피기동을 위해 사용하는 에너지는 매우 큰 비용을 발생시키며 많은 경우 인공위성의 수명과 직결되어 있기 때문에 매우 신중한 선택이 필수적이다. 따라서 회피기동의 최적설계라는 개념이 필요하다. 이 때 최적의 상태를 정의하기 위한 time window에 대한 정의가 필수적이다. 원하는 time window를 커버하는 동적 보로노이 다이어그램이 계산되어 있다고 하고 우리가 관심 있는 인공위성 S가 조금 후에 충돌한다는 판단이 되었고 이제 곧 회피기동을 위한 의사결정을 해야 한다고 하자. 본 발명에서는 이미 계산된 동적 보로노이 다이어그램에 회피기동의 주체가 되는 이동체(S)의 복사본인 S1를 하나 만들어서 이동체와 같은 위치에 둔다. 이 때 S1은 이동체(S)와 비교해서 각도의 차이가 있거나 속도의 차이가 있거나 또는 각도와 속도가 모두 조금씩 차이가 있는 상태가 된다. 이 때 time window를 따라 시간이 지나면서 S1이 각 순간의 동적 보로노이 다이어그램을 이용하여 인접한 다른 물체들과의 인접관계를 분석하면 된다. 이렇게 하면 하나의 회피기동 대안을 평균 O(K) 시간에 평가할 수 있게 된다. 이 때 K는 동적 보로노이 다이어그램의 time window전체에 걸쳐 존재하는 이벤트의 개수이다. S1과 상이한 또 다른 회피기동 S2를 생성할 수 있다. 이 때 주어진 동적 보로노이 다이어그램에 S1과 S2를 독립적으로 사용하여 해를 구할 수 있다. 즉, 동적 보로노이 다이어그램에 기반하여 회피경로의 최적해를 구하는 알고리즘을 병렬처리 할 수 있고 각 회피경로의 평가는 O(K)에 할 수 있어서 매우 신속하게 최적해를 구할 수 있다. 모든 후보 회피기동을 평가하여 그 중 최선의 답을 해로 삼는다. 또한, 다양한 후보 해 들 중에서 좋은 해를 찾는 방법으로는 인공지능 기능이 추가적으로 사용될 수 있다. In order to avoid this when it is predicted that two of the plurality of moving objects are proximate / crashing after? T time, one or all of them must be modified to avoid collision. Here, the equation of the movement path also includes the movement path and the magnitude of the speed according to the time within the movement path. Therefore, the method of modifying the equation of the moving path may be a method of changing only one of the moving path and the moving speed or both the moving path and the moving speed. At this time, the movement path and the movement speed may include a nonlinearity. Given that many moving bodies are moving and at any time any moving object can modify the equation of the moving path, the optimal way of evading path finding the safest escape path is to make various candidate solutions and evaluate each of them quickly. Choose the most favorable solution. It is important to minimize the energy (fuel, battery, etc.) used for the moving object to be the target of the present invention. For example, in the case of satellites, the energy used for avoiding maneuvers is very expensive and in many cases directly linked to the life of the satellites, so careful selection is essential. Therefore, the concept of optimal design of evasion operation is needed. At this time, it is essential to define the time window to define the optimal state. Suppose we have a dynamic Voronoi diagram that covers the desired time window, and we decide that satellite S of interest will collide a little later, and soon we need to make a decision to dodge. In the present invention, one copy of S1, which is a copy of the moving object S, which is the main cause of avoidance triggering, is placed in the same position as the moving object in the dynamic Voronoi diagram already calculated. At this time, S1 is in a state where there is a difference in angle, a difference in speed, or a slight difference in both the angle and the speed compared to the moving body S. At this time, as time passes along the time window, S1 uses the dynamic Voronoi diagram at each moment to analyze the close relationship with other adjacent objects. This allows one evasive starting alternative to be evaluated at an average O (K) time. Where K is the number of events that exist across the time window of the dynamic Voronoi diagram. It is possible to generate another avoidance trigger S2 that is different from S1. In this case, a solution can be obtained by using S1 and S2 independently in a given dynamic Voronoi diagram. In other words, the algorithm for finding the optimal solution of the avoidance path can be parallelized based on the dynamic Voronoi diagram, and each of the avoidance paths can be evaluated in O (K), so the optimal solution can be found very quickly. Evaluate all candidate evasions and make the best answer for them. In addition, the AI function may be additionally used as a method for finding a good solution among various candidate solutions.
도 14는 본 발명의 일 실시 예에 따라 드론의 충돌 및 근접관계를 예측하고, 회피경로를 제공하는 방법을 설명하기 위한 도면이다. 도 14를 참조하면, (A) 내지 (E)는 드론들이 본 발명에 따른 이동체의 충돌 및 근접관계의 예측방법을 통해 충돌을 예측하고 회피경로를 설정함으로써 충돌 없이 3차원 공간을 2차원 별모양의 형상에서 두 개의 원 모양으로 이동하는 과정을 순차적으로 나타내고 있다. 본 실시 예에서는 100대의 드론이 사용되었으며, 각각의 이동 구는 움직이는 드론을 모델링한 것이다. 특정시점 t1에서의 이동 구들의 위치(A)에서 일정시간이 지난 후 시점 t2에서의 이동 구들의 위치(E)로 드론들을 이동시키고자 할 경우, 이 때 특정 드론의 시작점과 끝나는 점은 정해져 있고 드론은 두 점 사이에서 선형으로 움직인다. 따라서 시간구간 (t1, t2)동안에 움직이는 이동 구들 사이의 동적 보로노이 다이어그램을 계산하면 충돌 예측이 가능하며 이런 상황이 발생하면 두 개의 이동 구들 중에서 하나를 정지시키고 (또는 천천히 이동시키고) 또 다른 하나를 빨리 이동시켜서 충돌을 회피하도록 제어할 수 있다. 필요에 따라 보로노이 다이어그램의 공간정보를 보다 적극적으로 활용하면 드론의 회피경로를 앞서 설명한 선형의 경로에서 비선형의 경로로 변경하는 보다 복잡한 상황까지 반영할 수 도 있다.FIG. 14 is a diagram illustrating a method of predicting a collision and proximity of a drone and providing an avoiding path according to an embodiment of the present invention. Referring to FIG. 14, (A) to (E) show that a drone predicts a collision and sets an avoidance path through a method of predicting collision and proximity of a moving object according to the present invention, thereby forming a two-dimensional star in a three-dimensional space without collision. The process of moving from two shapes to two circles is shown sequentially. In the present embodiment, 100 drones are used, and each of the moving spheres models a moving drone. When the drones are moved to the position E of the moving spheres at a time point t2 after a predetermined time at the position A of the moving spheres at a specific time point t1, the starting point and the end point of the specific drone are determined at this time. Drones move linearly between two points. Thus, calculating a dynamic Voronoi diagram between moving spheres during a time interval (t1, t2) allows collision prediction, and if this happens, stop one of the two spheres (or move it slowly) You can move it quickly to avoid collisions. If necessary, the spatial information in the Voronoi diagram can be used more actively to reflect more complicated situations such as changing the drone avoidance path from the linear path described above to the non-linear path.
도 15는 본 발명의 다른 실시 예에 따라 드론의 충돌을 예측하고, 회피경로를 제공하는 방법을 설명하기 위한 도면이다.FIG. 15 is a diagram for describing a method of predicting a collision of a drone and providing an avoiding path, according to another exemplary embodiment.
도 15를 참조하면, (A) 내지 (E)는 드론들이 본 발명에 따른 이동체의 충돌예측방법을 통해 충돌을 예측하고 회피경로를 설정함으로써 충돌 없이 3차원 공간을 이동하는 과정을 순차적으로 나타내고 있다. 본 실시 예에서는 500대의 드론이 사용되었으며, 각각의 이동 구는 움직이는 드론을 모델링한 것이다. 이동 구들은 토끼 모양의 군집에서 손 모양의 군집으로 변화되는 모습을 보여준다. 특정시점 t1에서의 이동 구들의 위치(A)에서 일정시간이 지난 후 시점 t2에서의 이동 구들의 위치(E)로 드론들을 이동시키고자 할 경우, 이 때 특정 드론의 시작점과 끝나는 점은 정해져 있고 드론은 두 점 사이에서 선형으로 움직인다. 따라서 시간구간 (t1, t2)동안에 움직이는 이동 구들 사이의 동적 보로노이 다이어그램을 계산하면 충돌 예측이 가능하며 이런 상황이 발생하면 두 개의 이동 구들 중에서 하나를 정지시키고 (또는 천천히 이동시키고) 또 다른 하나를 빨리 이동시켜서 충돌을 회피하도록 제어할 수 있다. 필요에 따라 보로노이 다이어그램의 공간정보를 보다 적극적으로 활용하면 드론의 회피경로를 앞서 설명한 선형의 경로에서 비선형의 경로로 변경하는 보다 복잡한 상황까지 반영할 수 도 있다. Referring to FIG. 15, (A) to (E) sequentially illustrate a process in which drones move three-dimensional space without collision by predicting collision and setting an avoidance path through a collision prediction method of a moving object according to the present invention. . In the present embodiment, 500 drones were used, and each of the moving spheres models a moving drone. The moving spheres change from a rabbit-shaped cluster to a hand-shaped cluster. When the drones are moved to the position E of the moving spheres at a time point t2 after a predetermined time at the position A of the moving spheres at a specific time point t1, the starting point and the end point of the specific drone are determined at this time. Drones move linearly between two points. Thus, calculating a dynamic Voronoi diagram between moving spheres during a time interval (t1, t2) allows collision prediction, and if this happens, stop one of the two spheres (or move it slowly) You can move it quickly to avoid collisions. If necessary, the spatial information in the Voronoi diagram can be used more actively to reflect more complicated situations such as changing the drone avoidance path from the linear path described above to the non-linear path.
이하, 본 발명의 실시 예에 따라 이동 경로가 알려져 있는 이동체들의 충돌을 예측하는 방법에 대해 설명한다. 본 발명에서는 이동 경로가 알려져 있는 이동체를 지구 둘레를 공정하는 인공위성을 예를 들어 설명하나, 이동 경로가 알려져 있는 이동체는 이에 국한되지 않으며 일정 궤도를 따라 움직이는 다양한 물체들의 충돌 예측에 적용될 수 있다. 또한, 본 발명에서는 3차원 이동 구를 예를 들어 설명하나, 본 발명의 기술적 사상은 2차원 이동 디스크에서 동일하게 적용될 수 있다. 또한, 이해의 편의를 위해 이동 구를 2차원 상에 표현하였으나, 3차원으로 용이하게 이해될 수 있을 것이다. Hereinafter, a method of predicting collision of moving objects for which a moving path is known according to an embodiment of the present invention will be described. In the present invention, a moving object known to the moving path is described as an example of a satellite for processing around the earth, the moving object known to the moving path is not limited to this can be applied to the collision prediction of various objects moving along a certain orbit. In the present invention, a three-dimensional moving sphere is described as an example, but the technical idea of the present invention can be equally applied to a two-dimensional moving disk. In addition, although the moving sphere is represented on two dimensions for convenience of understanding, it will be easily understood in three dimensions.
도 16은 본 발명의 일 실시예에 따라 이동 경로가 알려져 있는 이동체들의 충돌을 예측하는 방법을 설명하기 위한 도면이고, 도 16은 이동체들의 충돌 여부를 판단하는 방법을 설명하기 위한 도면이다. FIG. 16 is a diagram for describing a method of predicting a collision of moving bodies in which a moving path is known according to one embodiment of the present invention, and FIG. 16 is a diagram for describing a method of determining whether a moving body collides with each other.
먼저, 도 16을 참조하면, 인공위성들은 도 1에서 설명한 이동체 모델링부(120)에 의해 이동 구들로 모델링될 수 있다. 제1 내지 제3 이동 구(210, 310, 410)는 각각의 궤도(220, 320, 420)을 따라 지구(1000) 둘레를 공정한다.First, referring to FIG. 16, the satellites may be modeled as moving spheres by the moving
(A)는 제1 기준 시점에서의 제1 내지 제3 이동 구(210, 310, 410)들의 위치를 나타내고, (B)는 상기 제1 기준 시점으로부터 기 설정된 시간이 경과된 제2 기준 시점에서의 제1 내지 제3 이동 구(210, 310, 410)들의 위치를 나타내고, (C)는 상기 제2 기준 시점으로부터 기 설정된 시간이 경과된 제3 기준 시점에서의 제1 내지 제3 이동 구(210, 310, 410)들의 위치를 나타낸다.(A) shows the positions of the first to third moving
(A)를 참조하면, 상기 제1 기준 시점에서 제1 내지 제3 이동 구(210, 310, 410)들에 대한 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 면(P1, P2, P3)이 산출된다.Referring to (A), the surfaces P1, P2, and P3 of the Voronoi diagram are calculated by calculating Voronoi diagrams for the first to third moving
제1 내지 제3 이동 구(210, 310, 410)들 중 보로노이 다이어그램의 면(P3)과 가장 인접한 제2 및 제3 이동 구(310, 410)가 충돌 예상 물체들로 추출된다.Among the first to third moving
상기 충돌 예상 물체들로 추출된 제2 및 제3 이동 구(310, 410)들의 이동 속도를 분석하여, 충돌 여부를 판단한다.The collision speed is determined by analyzing the moving speeds of the second and third moving
도 17을 참조하면, 충돌이 예상되는 제2 및 제3 이동 구(310, 410)를 아래의 조건으로 설정할 수 있다. 제2 이동 구(310)의 반경은 rA이고, 제3 이동 구(410)의 반경은 rB이다, 제2 이동 구(310)의 제1 기준 시점에서의 중심점(A) 위치는 (Ax, Ay, Az)이고, 제3 이동 구(410)의 상기 제1 기준 시점에서의 중심점(B) 위치는 (Bx, By, Bz)이다. 제2 이동 구(310)가 궤도를 따라 이동하는 속도는 VA=(vx, vy, vz)이고, 제3 이동 구(410)가 궤도를 따라 이동하는 속도는 UB=(ux, uy, uz)이다.Referring to FIG. 17, the second and third moving
상술된 조건들에서, 상기 제1 기준 시점에서부터 t 시간 경과 후, 제2 이동 구(310)의 중심점(A)의 예상 위치는 A(t)이고, 제3 이동 구(410)의 중심점(B)의 예상 위치는 B(t)로 정의되며, 제2 이동 구(310)와 제3 이동 구(410)의 충돌 여부는 하기 수학식 1을 통해 연산될 수 있다.In the above-described conditions, the estimated position of the center point A of the second moving
[수학식 3][Equation 3]
(rx는 Ax-Bx, ry는 Ay-By, rz는 Az-Bz, wx는 vx-ux, wy는 vy-uy, wz는 vz-uz)(r x is A x -B x , r y is A y -B y , r z is A z -B z , w x is v x -u x , w y is v y -u y , w z is v z- u z )
d(t)는 상기 제1 기준 시점에서부터 t 시간 경과 후, 제2 이동 구(310)와 제3 이동 구(410) 사이의 거리이다. d(t)가 제2 이동 구(310)의 반경(rA)과 제3 이동 구(410)의 반경(rB)의 합에 수렴할 경우, 제2 이동 구(310)와 제3 이동 구(410)가 충돌하는 것으로 판단할 수 있다.d (t) is a distance between the second moving
제2 이동 구(310)와 제3 이동 구(410)의 충돌 시점은 하기 수학식 2를 통해 연산될 수 있다.The collision point of the second moving
[수학식 4][Equation 4]
실시 예에 따르면, 제2 및 제3 이동 구(310, 410)들은 충돌하지 않는 것으로 판단된다.According to an embodiment, it is determined that the second and third moving
다시 도 16의 (B)를 참조하면, 상기 제2 기준 시점에서 제1 내지 제3 이동 구(210, 310, 410)들에 대한 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 면(P1, P2, P3)이 산출된다.Referring again to FIG. 16B, the surfaces P1, P2, and P of the Voronoi diagram may be calculated by calculating Voronoi diagrams of the first to third moving
제1 내지 제3 이동 구(210, 310, 410)들 중 보로노이 다이어그램의 면(P1, P2, P3)과 가장 인접한 제2 및 제3 이동 구(310, 410)가 충돌 예상 물체들로 추출된다.Among the first to third moving
상기 충돌 예상 물체들로 추출된 제2 및 제3 이동 구(310, 410)들의 이동 속도를 분석하여, 도 17에서 설명한 방법으로 충돌 여부를 판단한다. 실시 예에 따르면, 제2 및 제3 이동 구(310, 410)들은 충돌하지 않는 것으로 판단된다.By analyzing the moving speeds of the second and third moving
(C)를 참조하면, 상기 제3 기준 시점에서 제1 내지 제3 이동 구(210, 310, 410)들의 위치를 확인할 수 있다. 상기 제3 기준 시점에서 제2 및 제3 이동 구(310, 410)들이 충돌하는 것을 알 수 있다.Referring to (C), the positions of the first to third moving
도 18은 본 발명의 다른 실시예에 따라 이동 경로가 알려져 있는 이동체들의 충돌을 예측하는 방법을 설명하기 위한 순서도이다. 본 실시 예에서는 도 15와 같이, 인공위성들의 충돌을 예측하는 방법을 예를 들어 설명한다.18 is a flowchart illustrating a method of predicting collision of moving objects for which a moving path is known according to another embodiment of the present invention. In the present embodiment, as shown in FIG. 15, a method of predicting collision of satellites will be described as an example.
도 18을 참조하면, 이동 경로가 알려져 있는 이동체들의 충돌을 예측하는 방법은 이동 구들의 1차 충돌 여부 판단 단계(S300)와 이동 구들의 2차 판단 단계(S4000를 포함한다.Referring to FIG. 18, a method of predicting collision of moving objects for which a moving path is known includes a first collision determination step S300 of moving spheres and a second determination step S4000 of moving spheres.
이동 구들의 1차 충돌 여부 판단 단계(S300)는 1차 궤도 근사화 및 이동 구들의 크기 보정 단계(S310), 보로노이 다이어그램의 면 산출 단계(S320), 충돌 예상 물체 추출 단계(S330), 그리고 충돌 여부 판단 단계(S340)를 포함한다.In the first collision determination step (S300) of the moving spheres, the first orbital approximation and the step of correcting the size of the moving spheres (S310), the surface calculation step (S320) of the Voronoi diagram, the collision prediction object extraction step (S330), and the collision It includes a determination step (S340).
1차 궤도 근사화 및 이동 구들의 크기 보정 단계(S310)는 이동 구들의 궤도를 n 개의 직선 구간으로 근사화하여 제1 근사 궤도들을 생성한다. 그리고 상기 이동 구들의 궤도와 상기 제1 근사 궤도들 간의 오차를 반영하여, 상기 이동 구들의 크기를 1차 보정한다.In the first orbital approximation and the size correction step S310 of the moving spheres, the trajectories of the moving spheres are approximated to n straight sections to generate first approximate orbits. The size of the moving spheres is first corrected by reflecting an error between the trajectories of the moving spheres and the first approximate orbits.
상기 크기가 1차 보정된 이동 구들 간의 충돌 여부를 판단하기 위해, 상기 크기가 1차 보정된 이동 구들에 대해 보로노이 다이어그램의 면 산출 단계(S320), 충돌 예상 물체 추출 단계(S330) 그리고 충돌 여부 판단 단계(S340)를 수행한다. 보로노이 다이어그램의 면 산출 단계(S320), 충돌 예상 물체 추출 단계(S330) 그리고 충돌 여부 판단 단계(S340)는 도 11에서 설명된 것과 동일하게 수행될 수 있다.In order to determine whether or not there is a collision between the first-corrected moving spheres, the plane calculation step (S320) of the Voronoi diagram, the collision prediction object extraction step (S330), and whether there is a collision The determination step S340 is performed. The plane calculation step S320, the collision prediction object extraction step S330, and the collision determination step S340 of the Voronoi diagram may be performed in the same manner as described with reference to FIG. 11.
이동 구들의 1차 충돌 여부 판단 단계(S300)에서 상기 크기가 1차 보정된 이동 구들 간의 충돌이 발생하지 않은 것으로 판단되는 경우, 기 설정된 시간의 경과마다 이동 구들의 충돌 여부 판단 단계(S300)가 반복될 수 있다.When it is determined that the collision between the moving spheres whose size is first corrected does not occur in the first collision determination step (S300) of the moving spheres, the determination of whether the moving spheres collide with each other over a predetermined time period (S300) Can be repeated.
이동 구들의 1차 충돌 여부 판단 단계(S300)에서 상기 크기가 1차 보정된 이동 구들 간의 충돌이 발생한 것으로 판단되는 경우, 이동 구들의 2차 충돌 여부 판단 단계(S400)가 수행된다. 이동 구들의 2차 충돌 여부 판단 단계(S400)는 2차 궤도 근사화 및 이동 구들의 크기 보정 단계(S410), 보로노이 다이어그램의 면 산출 단계(S420), 충돌 예상 물체 추출 단계(S430), 그리고 충돌 여부 판단 단계(S440)를 포함한다.When it is determined that collision between the moving spheres whose size is first corrected has occurred in the first collision determination step (S300) of the moving spheres, the second collision determination step (S400) of the moving spheres is performed. The second collision determination step (S400) of the moving spheres is the secondary orbital approximation and the size correction step of the moving spheres (S410), the surface calculation step (S420) of the Voronoi diagram, the collision prediction object extraction step (S430), and the collision It includes a determination step (S440).
2차 궤도 근사화 및 이동 구들의 크기 보정 단계(S410)는 상기 이동 구들의 궤도를 상기 n 개보다 큰 m 개의 직선 구간으로 근사화하여 제2 근사 궤도들을 생성한다. 그리고 상기 이동 구들의 궤도와 상기 제2 근사 궤도들 간의 오차를 반영하여 상기 이동 구들의 크기를 2차 보정한다. 상기 크기가 2차 보정된 이동 구들의 크기는 1차 보정된 이동 구들의 크기보다 작다.The second orbital approximation and the size correction step (S410) of the moving spheres to approximate the trajectory of the moving spheres to m linear sections larger than n to generate second approximate orbits. The size of the moving spheres is secondarily corrected by reflecting an error between the moving spheres and the second approximate orbits. The size of the second-corrected moving spheres is smaller than the size of the first-corrected moving spheres.
상기 크기가 2차 보정된 이동 구들 간의 충돌 여부를 판단하기 위해, 상기 크기가 2차 보정된 이동 구들에 대해 보로노이 다이어그램의 면 산출 단계(S420), 충돌 예상 물체 추출 단계(S430) 그리고 충돌 여부 판단 단계(S440)를 수행한다.In order to determine whether the collisions between the second-corrected moving spheres are corrected, the plane calculation step (S420), the collision prediction object extraction step (S430), and whether there is a collision in the Voronoi diagram for the second-corrected moving spheres The determination step S440 is performed.
2차 물체 충돌 여부 판단 단계(S400)에서 상기 크기가 2차 보정된 이동 구들 간의 충돌이 발생하지 않은 것으로 판단되는 경우, 기 설정된 주기마다 이동 구들의 2차 충돌 여부 판단 단계(S400)가 반복적으로 수행될 수 있다.When it is determined that the collision between the moving spheres whose size is second-corrected has not occurred in the secondary object collision determination step (S400), the secondary collision determination step (S400) of the moving spheres is repeatedly performed at predetermined periods. Can be performed.
이동 구들의 2차 충돌 여부 판단 단계(S400)에서 상기 크기가 2차 보정된 이동 구들 간의 충돌이 발생한 것으로 판단되는 경우, 상기 이동 구들의 궤도를 상기 m 개보다 더 많은 직선 구간들로 근사화하여 이동 구들의 충돌 여부를 판단하는 3차 물체 충돌 여부 판단을 수행할 수 있다. 또는, 다른 실시 예에 따르면, 이동 구들의 3차 충돌 여부 판단은 궤도 근사화 및 이동 구들의 크기 보정을 하지 않고, 이동 구들의 실제 크기와 이동 구들의 알려져 있는 실제 궤도에서 이동 구들의 충돌 여부를 판단할 수 있다.When it is determined in step S400 of whether the collision of the moving spheres has occurred, the collision between the two spheres whose size is second-corrected is approximated, and the trajectories of the moving spheres are approximated to more than m straight sections. A third object collision determination that determines whether the spheres collide may be performed. Alternatively, according to another embodiment, the third collision determination of the moving spheres does not approximate the trajectory approximation and the size correction of the moving spheres, and determines whether the moving spheres collide with each other in the known actual orbit of the moving spheres. can do.
이동구들의 3차 충돌 여부 판단 단계는 앞서 설명한 이동 구들에 대해 보로노이 다이어그램의 면 산출 단계, 충돌 예상 물체 추출 단계, 그리고 충돌 여부 판단 단계를 포함한다.The third collision determination step of the moving spheres includes a plane calculation step, a collision prediction object extraction step, and a collision determination step of the Voronoi diagram for the moving spheres described above.
도 19는 도 18에서 설명한 이동 구들의 1차 충돌 여부 판단 단계를 자세하게 설명하기 위한 도면이고, 도 20은 도 18에서 설명한 이동 구들의 2차 충돌 여부 판단 단계를 자세하게 설명하기 위한 도면이고, 도 21은 도 18에서 설명한 이동 구들의 3차 충돌 여부 판단 단계를 자세하게 설명하기 위한 도면이다.19 is a view for explaining in detail the first collision determination step of the moving spheres described in FIG. 18, FIG. 20 is a view for explaining in detail the second collision determination step of the moving spheres described in Figure 18, Figure 21 FIG. 18 is a diagram for describing a third collision determination step of the moving spheres described with reference to FIG. 18 in detail.
먼저, 도 19를 참조하면, 제1 기준 시점(A)에서 제1 내지 제3 궤도(220, 320, 420)를 5 개의 직선 구간으로 근사화 하여 제1 내지 제3 이동 구(210, 310, 410)의 제1 근사 궤도(230, 330, 430)를 생성한다. 제1 내지 제3 궤도(220, 320, 420)와 제1 내지 제3 이동 구(210, 310, 410)들의 제1 근사 궤도(230, 330, 430) 간의 오차를 반영하여 제1 내지 제3 이동 구(210, 310, 410)들의 크기를 1차 보정한다.First, referring to FIG. 19, first to third moving
크기가 1차 보정된 제1 내지 제3 이동 구(240, 340, 440)들에 대한 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 면(P1, P2, P3)이 산출된다.The surfaces P1, P2, and P3 of the Voronoi diagram are calculated by calculating the Voronoi diagrams of the first to third moving
크기가 1차 보정된 제1 내지 제3 이동 구(240, 340, 440)들 중 보로노이 다이어그램의 면(P3)과 가장 인접한 크기가 1차 보정된 제2 및 제3 이동 구(340, 440)가 충돌 예상 물체들로 추출된다.Among the first to third moving
상기 충돌 예상 물체들로 추출된 크기가 1차 보정된 제2 및 제3 이동 구(340, 440)의 이동 속도를 분석하여, 충돌 여부를 판단한다. 실시 예에 따르면, 크기가 1차 보정된 제2 및 제3 이동 구(340, 440)은 충돌하지 않는 것으로 판단된다.The collision speed is determined by analyzing the moving speeds of the second and third moving
이후, 크기가 1차 보정된 제1 내지 제3 이동 구(240, 340, 440)들 간의 충돌 여부 판단은 기 설정된 주기마다 반복적으로 수행될 수 있다.Thereafter, the collision determination between the first to third moving
제2 기준 시점(B)에서, 크기가 1차 보정된 제1 및 제2 이동 구(240, 340)가 충돌 예상 물체들로 추출되고, 크기가 1차 보정된 제1 및 제2 이동 구(240, 340)의 이동 속도를 분석하여, 충돌 여부를 판단한다. 실시 예에 따르면, 크기가 1차 보정된 제1 및 제2 이동 구(240, 340)는 충돌하는 것으로 판단된다.At the second reference time point B, the first and second moving
도 20의 (A)를 참조하면, 크기가 1차 보정된 제1 및 제2 이동 구(240, 340)가 충돌하는 것으로 판단되면, 제1 내지 제3 궤도(220, 320, 420)를 10 개의 직선 구간으로 근사화 하여 제1 내지 제3 이동 구(210, 310, 410)들의 제2 근사 궤도(250, 350, 450)를 생성한다. 제1 내지 제3 궤도 (220, 320, 420)와 제1 내지 제3 이동 구(210, 310, 410)들의 제2 근사 궤도(250, 350, 450) 간의 오차를 반영하여 크기가 1차 보정된 제1 내지 제3 이동 구(240, 340, 440)들의 크기를 2차 보정한다.Referring to FIG. 20A, when it is determined that the first and second moving
크기가 2차 보정된 제1 내지 제3 이동 구(260, 360, 460)들에 대한 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 면(P1, P2, P3)이 산출된다.The surfaces P1, P2, and P3 of the Voronoi diagram are calculated by calculating the Voronoi diagrams of the first to third moving
크기가 2차 보정된 제1 내지 제3 이동 구(260, 360, 460)들 중 보로노이 다이어그램의 면(P1)과 가장 인접한 크기가 2차 보정된 제1 및 제2 이동 구(260, 360)가 충돌 예상 물체들로 추출된다.Among the first to third moving
상기 충돌 예상 물체들로 추출된 크기가 2차 보정된 제1 및 제2 이동 구(260, 360)의 이동 속도를 분석하여, 충돌 여부를 판단한다. 실시 예에 따르면, 크기가 2차 보정된 제1 및 제2 이동 구(260, 360)들은 충돌하지 않는 것으로 판단된다.The collision speed is determined by analyzing the moving speeds of the first and second moving
이후, 크기가 2차 보정된 제1 내지 제3 이동 구(240, 340, 440)들 간의 충돌 여부 판단은 기 설정된 주기마다 반복적으로 수행될 수 있다.Thereafter, the collision determination between the first to third moving
제3 기준 시점(B)에서 크기가 2차 보정된 제2 및 제3 이동 구(360, 460)들이 상기 충돌 예상 물체들로 추출되고, 크기가 2차 보정된 제2 및 제3 이동 구(360, 460)들의 이동 속도를 분석하여, 충돌 여부를 판단한다. 실시 예에 따르면, 크기가 2차 보정된 제2 및 제3 이동 구(360, 460)들이 서로 충돌하는 것으로 판단된다.The second and third moving
크기가 2차 보정된 제2 및 제3 이동 구(360, 460)들이 서로 충돌하는 것으로 판단되면, 이동 구들의 3차 충돌 여부 판단 단계가 수행된다.If it is determined that the second and third moving
도 21을 참조하면, 제3 기준 시점에서 제2 및 제3 이동 구(310, 410)들이 상기 충돌 예상 물체들로 추출되고, 제2 및 제3 이동 구(310, 410)들의 이동 속도를 분석하여 충돌 여부를 판단한다. 실시 예에 따르면, 제2 및 제3 이동 구(310, 410)들이 충돌하는 것으로 판단된다.Referring to FIG. 21, at the third reference time point, second and third moving
도 20의 (B)와 도 21의 결과를 비교하면, 이동 구(310, 410)들의 2차 충돌 여부 판단 결과가 이동 구(310, 410)의 실제 궤도에 따라 물체의 충돌 여부를 판단하는 이동 구(310, 410)들의 3차 충돌 여부 판단 결과와 일치하는 것을 알 수 있다.Comparing the results of FIG. 20B with the results of FIG. 21, the second collision determination result of the moving
따라서, 본 발명의 실시 예에 따른 이동 경로가 알려져 있는 이동체(210, 310, 410)들의 충돌을 예측하는 방법은 충돌 예측에 요구되는 전체 계산량이 감소되고 충돌 예측 속도가 향상되어 충돌 예측의 정확도가 향상될 수 있다.Therefore, the collision prediction method of the moving
이상, 본 발명을 바람직한 실시 예를 사용하여 상세히 설명하였으나, 본 발명의 범위는 특정 실시 예에 한정되는 것은 아니며, 첨부된 특허청구범위에 의하여 해석되어야 할 것이다. 또한, 이 기술분야에서 통상의 지식을 습득한 자라면, 본 발명의 범위에서 벗어나지 않으면서도 많은 수정과 변형이 가능함을 이해하여야 할 것이다.As mentioned above, although this invention was demonstrated in detail using the preferable embodiment, the scope of the present invention is not limited to a specific embodiment, Comprising: It should be interpreted by the attached Claim. In addition, those skilled in the art should understand that many modifications and variations are possible without departing from the scope of the present invention.
100: 이동체들 사이의 충돌 예측 및 회피 시스템
110: 이동체 정보 수신부
120: 이동체 모델링부
130: 충돌 예측부
10: 이동체
11: 오브젝트
12: 2차원 원, 3차원 구
13: 이동 디스크, 이동 구
14: 기하학적 형성
21 내지 25: 내접 원, 내접 구
E1, E2, E3, ···: 보로노이 다이어그램의 모서리
V1, V2, ···: 보로노이 다이어그램의 꼭지점
S1 내지 S5: 이동 구
P1, P2, P3: 보로노이 다이어그램의 면
S: 이동체
210, 310, 410: 이동 구
220, 320, 420: 궤도
230, 330, 430: 근사 궤도
1000: 지구100: collision prediction and avoidance system between moving objects
110: moving object information receiving unit
120: moving object modeling unit
130: collision prediction unit
10: moving object
11: object
12: two-dimensional circle, three-dimensional sphere
13: moving disk, moving sphere
14: Geometric Formation
21 to 25: inscribed circle, inscribed sphere
E1, E2, E3, ...: edge of Voronoi diagram
V1, V2, ... vertex of Voronoi diagram
S1 to S5: moving sphere
P1, P2, P3: Faces of Voronoi Diagram
S: moving object
210, 310, 410: moving sphere
220, 320, 420: Orbit
230, 330, 430: approximate orbit
1000: Earth
Claims (23)
상기 오브젝트들의 크기 정보로부터 상기 오브젝트들을 모델링하여 2차원 원을 생성하는 단계;
상기 이동체들의 이동속도와 상기 이동체들의 모니터링 시간 구간, 그리고 상기 2차원 원들의 크기 정보 중 적어도 어느 하나의 이용으로 상기 2차원 원들을 이동 디스크들로 모델링하는 단계;
상기 이동 디스크들 간에 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 모서리들을 산출하는 단계; 및
상기 이동체들의 모니터링 시간 구간 동안, 상기 보로노이 다이어그램의 모서리들 중 적어도 어느 하나가 꼭지점을 거쳐 다시 모서리로 전환되는 플리핑 이벤트와, 상기 보로노이 다이어그램의 모서리를 정의하는 한 쌍의 이동 디스크들 간에 충돌을 예측하는 충돌 이벤트를 계산하고, 상기 플리핑 이벤트와 상기 충돌 이벤트의 발생시간이 빠른 순으로 상기 플리핑 이벤트를 발생시키는 이동 디스크들 간에, 그리고 상기 충돌 이벤트를 발생시키는 이동 디스크들 간에 실제 충돌여부를 계산하는 단계를 포함하는 이동체들 사이의 충돌 예측 및 회피 방법.Modeling shapes of each of the plurality of moving objects to generate objects;
Modeling the objects from the size information of the objects to generate a two-dimensional circle;
Modeling the two-dimensional circles as moving disks by using at least one of a moving speed of the moving bodies, a monitoring time interval of the moving bodies, and size information of the two-dimensional circles;
Calculating corners of the Voronoi diagram by computing a Voronoi diagram between the moving disks; And
During a monitoring time interval of the moving objects, a flipping event in which at least one of the corners of the Voronoi diagram is converted back to a corner through a vertex and a pair of moving disks defining an edge of the Voronoi diagram Calculates a collision event predicting a value of the collision event, and whether the collision event occurs between mobile disks generating the flipping event in the order of occurrence of the collision event in the fastest order, and between the mobile disks generating the collision event; A collision prediction and avoidance method between moving objects comprising the step of calculating a.
상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트하는 단계를 더 포함하되,
상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는
상기 플리핑 이벤트가 발생되는 보로노이 다이어그램의 모서리 및 이와 연결된 다른 보로노이 다이어그램의 모서리들을 정의하는 이동 디스크들에 대해 보로노이 다이어그램을 재정의하고,
상기 플리핑 이벤트가 발생되는 보로노이 다이어그램의 모서리 및 이와 연결된 다른 보로노이 다이어그램의 모서리들에 대해 플리핑 이벤트의 발생 시간을 재계산하고,
상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리를 정의하는 한 쌍의 이동 디스크들 간에 충돌 이벤트의 발생 시간을 재계산하고,
재계산된 플리핑 이벤트와 충돌 이벤트의 발생시간이 빠른 순으로 플리핑 이벤트를 발생시키는 이동 디스크들 간에, 그리고 충돌 이벤트를 발생시키는 이동 디스크들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되,
상기 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보 업데이트는 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 플리핑 이벤트와 충돌 이벤트가 모두 발생되지 않을 경우 종료되는 이동체들간의 충돌 예측 방법.The method of claim 1,
The method may further include updating information of a Voronoi diagram in which the flipping event is generated.
The update of the information of the Voronoi diagram in which the flipping event is generated
Redefine the Voronoi diagram for the moving disks defining the corners of the Voronoi diagram where the flipping event is generated and the edges of other Voronoi diagrams connected thereto,
Recalculate the occurrence time of the flipping event for the corner of the Voronoi diagram where the flipping event is generated and the corners of another Voronoi diagram connected thereto;
Recalculate a time of occurrence of a collision event between a pair of moving disks defining an edge of a Voronoi diagram in which the flipping event occurred;
And recalculating the actual collision between the mobile disks generating the flipping event and the mobile disks generating the collision event in the order of occurrence of the recalculated flipping event and the collision event in ascending order.
The information update of the Voronoi diagram in which the flipping event is generated is repeated during the monitoring time interval of the moving objects, and ends when the flipping event and the collision event do not occur.
상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트하는 단계를 더 포함하되,
상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는,
상기 충돌 이벤트를 발생시키는 한 쌍의 이동 디스크들, 그리고 상기 한 쌍의 이동 디스크들과 보로노이 다이어그램의 모서리들을 정의하는 다른 이동 디스크들 서로 간에 충돌 이벤트 발생 시간을 재계산하고,
상기 충돌 이벤트를 발생시키는 한 쌍의 이동 디스크들이 정의하는 보로노이 다이어그램의 모서리, 그리고 상기 한 쌍의 이동 디스크들과 다른 이동 디스크들이 정의하는 보로노이 다이어그램의 모서리들, 그리고 상기 다른 이동 디스크들이 정의하는 보로노이 다이어그램의 모서리들에 대해 플리핑 이벤트 발생 시간을 재계산하고,
재계산된 충돌 이벤트와 플리핑 이벤트의 발생시간이 빠른 순으로 충돌 이벤트를 발생시키는 이동 디스크들 간에, 그리고 플리핑 이벤트를 발생시키는 이동 디스크들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되,
상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트는 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 플리핑 이벤트와 충돌 이벤트가 모두 발생되지 않을 경우 종료되는 이동체들간의 충돌 예측 방법.The method of claim 1,
The method may further include updating information of the Voronoi diagram in which the collision event occurred.
The update of the information of the Voronoi diagram in which the collision event occurred,
Recalculate a collision event occurrence time between the pair of mobile disks generating the collision event and the other pair of mobile disks defining edges of the Voronoi diagram;
An edge of the Voronoi diagram defined by the pair of moving disks generating the collision event, an edge of the Voronoi diagram defined by the pair of moving disks and the other moving disks, and defined by the other moving disks. Recalculate the flipping event occurrence time for the edges of the Voronoi diagram,
Recalculating the actual collision between the mobile disks generating the collision event and the mobile disks generating the flipping event in order of occurrence of the recalculated collision event and the flipping event in the fastest order;
The updating of information of the Voronoi diagram in which the collision event is generated is repeated during the monitoring time interval of the moving objects, and the collision prediction method between the moving objects is terminated when neither the flipping event nor the collision event occurs.
상기 2차원 원을 생성하는 단계는 상기 오브젝트들 각각을 외접하는 외접원을 생성하는 이동체들간의 충돌 예측 방법.The method of claim 1,
The generating of the two-dimensional circle may include collision prediction between moving bodies generating a circumscribed circle circumscribing each of the objects.
상기 이동 디스크들을 생성하는 단계는 수학식 1에 의해 상기 이동 디스크들의 반경을 결정하는 이동체들간의 충돌 예측 방법.
[수학식 1]
R = r +Vmax· tp + δ
(여기서, R은 이동 디스크들의 반경, r은 2차원 원의 반경, Vmax는 이동체의 최대 속도, tp 는 이동체들의 충돌 및 근접관계의 예측을 위한 계산시간, δ는 안전계수)The method of claim 1,
The generating of the moving disks may include determining a radius of the moving disks by using Equation 1 below.
[Equation 1]
R = r + V max t p + δ
(Where R is the radius of the moving disk, r is the radius of the two-dimensional circle, V max is the maximum velocity of the moving object, t p is the calculation time for the prediction of collision and proximity of the moving bodies, δ is the safety factor)
상기 이동 디스크들 간에 실제 충돌여부를 계산하는 단계는 상기 이동 디스크들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계를 더 포함하는 이동체들간의 충돌 예측 방법.The method of claim 1,
The calculating of the actual collision between the moving disks further comprises the step of determining whether the objects of the moving disks collision collision prediction method between moving objects.
상기 이동 디스크들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계는,
상기 오브젝트들 각각에 내접하는 복수 개의 내접원들로 상기 오브젝트들을 모델링하고, 상기 내접원 단위로 상기 이동체들의 충돌을 판단하는 이동체들간의 충돌 예측 방법.The method of claim 6,
Determining whether the objects of the removable disks collide,
And modeling the objects using a plurality of inscribed circles inscribed in each of the objects, and determining collisions of the moving objects in units of the inscribed circle.
상기 이동 디스크들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계는,
상기 이동체들의 비선형 이동경로를 복수 개의 선형 이동 경로로 근사화하고, 근사화된 상기 선형 이동 경로상에서 상기 이동체들의 방향전환 위치 및 각도를 알고 있는 경우, 상기 방향전환 위치 및 각도에서 방향전환된 오브젝트들을 포함하는 기하학적 형상으로 상기 오브젝트들을 모델링하고,
상기 기하학적 형상들간의 충돌을 판단하는 이동체들간의 충돌 예측 방법.The method of claim 6,
Determining whether the objects of the removable disks collide,
Approximating the non-linear movement path of the moving objects to a plurality of linear movement path, and if the direction and position of the moving object on the approximated linear movement path is known, including the objects redirected at the turning position and angle Model the objects in a geometric shape,
Collision prediction method between moving objects for determining the collision between the geometric shapes.
상기 이동체들은 각각의 궤도를 따라 이동하며,
상기 이동 디스크들 간에 실제 충돌여부를 계산하는 단계는 상기 보로노이 다이어그램의 모서리에 가장 인접한 상기 이동 디스크들을 충돌 예상 물체들로 추출하고, 상기 충돌 예상 물체들의 이동속도를 분석하여 상기 충돌 예상 물체들의 충돌 여부를 판단하는 이동체들간의 충돌 예측 방법.The method of claim 1,
The moving bodies move along their respective trajectories,
Calculating whether or not the actual collision between the moving disks is extracted from the moving disks closest to the edge of the Voronoi diagram as collision prediction objects, the moving speed of the collision prediction objects to analyze the collision of the collision prediction objects Collision prediction method between moving objects to determine whether or not.
상기 이동 디스크들 간에 실제 충돌여부를 계산하는 단계는,
상기 충돌 예상 물체들 중 제1 충돌 예상 물체(A)와 제2 충돌 예상 물체(B)의 반경이 각각 rA, rB이고, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)의 제1 기준 시점에서의 중심점 위치가 각각 (Ax, Ay), (Bx, By)이고, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)가 상기 궤도를 따라 이동하는 속도가 각각 VA=(vx, vy), UB=(ux, uy) 일 때,
t 시간 경과 후 상기 제1 충돌 예상 물체(A)의 예상 위치를 A(t), 상기 제2 충돌 예상 물체(B)의 예상 위치를 B(t)라 할 경우, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)의 충돌 여부는 하기 수학식 2를 통해 연산되는 물체 간 충돌 예측 방법.
[수학식 2]
(rx는 Ax-Bx, ry는 Ay-By, wx는 vx-ux, wy는 vy-uy)The method of claim 9,
Calculating the actual collision between the removable disks,
The radiuses of the first collision prediction object A and the second collision prediction object B among the collision prediction objects are r A and r B , respectively, and the first collision prediction object A and the second collision prediction object are respectively. The center point positions at the first reference time point of (B) are (A x , A y ), (B x , B y ), respectively, and the first collision prediction object A and the second collision prediction object B are When the speeds along the trajectory are V A = (v x , v y ) and U B = (u x , u y ),
When the estimated position of the first collision predicted object A is t (t) and the expected position of the second collision predicted object B is t (t) after a time elapses, the first collision predicted object ( The collision prediction method between the objects A) and whether the collision between the second collision prediction object (B) is calculated through Equation 2 below.
[Equation 2]
(r x is A x -B x , r y is A y -B y , w x is v x -u x , w y is v y -u y )
상기 오브젝트들의 크기 정보로부터 상기 오브젝트들을 3차원 구들로 모델링하는 단계;
상기 이동체들의 이동속도와 상기 이동체들의 모니터링 시간 구간, 그리고 상기 3차원 구들의 크기 정보 중 적어도 어느 하나의 이용으로 상기 3차원 구들을 모델링하여 이동 구들을 생성하는 단계;
상기 이동 구들 간의 보로노이 다이어그램을 연산하여 보로노이 다이어그램의 면과 모서리, 그리고 꼭지점을 산출하는 단계; 및
상기 이동체들의 모니터링 시간 구간 동안, 상기 보로노이 다이어그램의 모서리가 보로노이 다이어그램의 면으로 전환되는 모서리 플리핑 이벤트와, 상기 보로노이 다이어그램의 면이 보로노이 다이어그램의 모서리로 전환되는 면 플리핑 이벤트와, 상기 보로노이 다이어그램의 면을 정의하는 한 쌍의 이동 구들 간에 충돌을 예측하는 충돌 이벤트를 계산하고, 상기 모서리 플리핑 이벤트, 상기 면 플리핑 이벤트, 그리고 상기 충돌 이벤트의 발생시간이 빠른 순으로 상기 모서리 플리핑 이벤트를 발생시키는 이동 구들간에, 상기 면 플리핑 이벤트를 발생시키는 이동 구들 간에, 그리고 상기 상기 충돌 이벤트를 발생시키는 이동 구들 간에 실제 충돌여부를 계산하는 단계를 포함하는 이동체들 사이의 충돌 예측 및 회피 방법.Modeling shapes of each of the plurality of moving objects to generate objects;
Modeling the objects into three-dimensional spheres from the size information of the objects;
Generating moving spheres by modeling the three-dimensional spheres using at least one of a moving speed of the moving bodies, a monitoring time interval of the moving bodies, and size information of the three-dimensional spheres;
Calculating a plane, an edge, and a vertex of the Voronoi diagram by computing a Voronoi diagram between the moving spheres; And
An edge flipping event in which an edge of the Voronoi diagram is converted to a face of a Voronoi diagram during a monitoring time interval of the moving objects, and a face flipping event in which a face of the Voronoi diagram is turned into an edge of a Voronoi diagram; Compute a collision event that predicts a collision between a pair of moving spheres defining a face of the Voronoi diagram, and the edge flipping event, the face flipping event, and the occurrence time of the collision event in ascending order. Predicting collision between moving objects that generate a collision event between the moving spheres generating the flipping event, the moving spheres generating the plane flipping event, and the moving spheres generating the collision event; How to avoid.
상기 모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트 하는 단계를 더 포함하되,
상기 모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는,
상기 모서리 플리핑 이벤트가 발생된 이후의 보로노이 다이어그램의 면과, 이를 구성하는 꼭지점들과 맞닿은 보로노이 다이어그램의 모서리들을 정의하는 상기 이동 구들에 대해 보로노이 다이어그램을 재정의하고,
상기 꼭지점들과 맞닿은 보로노이 다이어그램의 모서리들에 대해 모서리 플리핑 이벤트의 발생을 재계산하고,
상기 모서리 플리핑 이벤트가 발생된 이후의 보로노이 다이어그램의 면에 대해 면 플리핑 이벤트의 발생을 재계산하고,
상기 모서리 플리핑 이벤트 발생의 재계산 이후에 생성된 보노로이 다이어그램의 면을 정의하는 상기 이동 구들간에 충돌 이벤트의 발생을 재계산하고,
재계산된 모서리 플리핑 이벤트와 면 플리핑 이벤트와, 충돌 이벤트의 발생시간이 빠른 순으로, 재계산된 모서리 플리핑 이벤트를 발생시키는 이동 구들 간에, 재계산된 면 플리핑 이벤트를 발생시키는 이동 구들 간에, 그리고 재계산된 충돌 이벤트를 발생시키는 이동 구들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되,
상기 모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트 는, 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 상기 모서리 플리핑 이벤트와 상기 면 플리핑 이벤트와 상기 충돌 이벤트가 모두 발생되지 않을 경우 종료되는 이동체들 사이의 충돌 예측 및 회피 방법.The method of claim 11,
The method may further include updating information of the Voronoi diagram in which the corner flipping event is generated.
The update of the information of the Voronoi diagram in which the edge flipping event is generated,
Redefine a Voronoi diagram for the moving spheres defining the face of the Voronoi diagram after the edge flipping event occurs and the corners of the Voronoi diagram that abut the vertices that make up the corner flipping event,
Recalculate the occurrence of an edge flipping event for the corners of the Voronoi diagram that abuts the vertices,
Recalculate the occurrence of the face flipping event for the face of the Voronoi diagram after the edge flipping event occurs;
Recalculate the occurrence of a collision event between the moving spheres defining a face of a boronoi diagram generated after recalculating the edge flipping event occurrence,
Move spheres that generate a recalculated face flipping event between the recomputed edge flipping event and the face flipping event, and the moving spheres that generate the recomputed edge flipping event in the order of occurrence of the collision event in the fastest time. Recalculating the actual collision between and between the moving spheres that generate the recalculated collision event,
The update of the information of the Voronoi diagram in which the edge flipping event is generated is repeated during the monitoring time interval of the moving objects, and ends when neither the edge flipping event, the face flipping event, or the collision event occurs. Method of collision prediction and avoidance between moving objects.
상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트 하는 단계를 더 포함하되,
상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는,
상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리 및 이와 맞닿는 보로노이 다이어그램의 모서리들을 정의하는 상기 이동 구들에 대해 보로노이 다이어그램을 재정의하고,
상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리 및 이와 연결되는 보로노이 다이어그램의 모서리에 대해 모서리 플리핑 이벤트의 발생을 재계산하고,
상기 면 플리핑 이벤트가 발생된 보로노이 다이어그램의 모서리와 연결된 보로노이 다이어그램의 면들에 대해 면 플리핑 이벤트의 발생을 재계산하고,
상기 모서리 플리핑 이벤트 발생의 재계산 이후에 생성된 보노로이 다이어그램의 면을 정의하는 상기 이동 구들간에 충돌 이벤트의 발생을 재계산하고,
재계산된 모서리 플리핑 이벤트와 면 플리핑 이벤트와, 충돌 이벤트의 발생시간이 빠른 순으로, 재계산된 모서리 플리핑 이벤트를 발생시키는 이동 구들 간에, 재계산된 면 플리핑 이벤트를 발생시키는 이동 구들 간에, 그리고 재계산된 충돌 이벤트를 발생시키는 이동 구들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되,
상기 모서리 플리핑 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트 는, 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 상기 모서리 플리핑 이벤트와 상기 면 플리핑 이벤트와 상기 충돌 이벤트가 모두 발생되지 않을 경우 종료되는 이동체들 사이의 충돌 예측 및 회피 방법.The method of claim 11,
The method may further include updating information of the Voronoi diagram in which the face flipping event is generated.
The update of the information of the Voronoi diagram in which the face flipping event is generated,
Redefine a Voronoi diagram for the moving spheres defining the corners of the Voronoi diagram where the face flipping event occurred and the corners of the Voronoi diagram that abut
Recalculating an occurrence of an edge flipping event for an edge of the Voronoi diagram where the face flipping event is generated and an edge of the Voronoi diagram connected thereto;
Recalculate the occurrence of the face flipping event for the faces of the Voronoi diagram connected to the edge of the Voronoi diagram where the face flipping event occurred;
Recalculate the occurrence of a collision event between the moving spheres defining a face of a boronoi diagram generated after recalculating the edge flipping event occurrence,
Move spheres that generate a recalculated face flipping event between the recomputed edge flipping event and the face flipping event, and the moving spheres that generate the recomputed edge flipping event in the order of occurrence of the collision event in the fastest time. Recalculating the actual collision between and between the moving spheres that generate the recalculated collision event,
The update of the information of the Voronoi diagram in which the edge flipping event is generated is repeated during the monitoring time interval of the moving objects, and ends when neither the edge flipping event, the face flipping event, or the collision event occurs. Method of collision prediction and avoidance between moving objects.
상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보를 업데이트 하는 단계를 더 포함하되,
상기 충돌 이벤트를 발생시키는 한 쌍의 이동 구들, 그리고 상기 한 쌍의 이동 구들과 보로노이 다이어그램의 면들을 정의하는 다른 이동 구들에 대해 충돌 이벤트 발생을 재계산하고,
상기 한 쌍의 이동 구들과 상기 다른 이동 구들에 의해 정의되는 상기 보로노이 다이어그램의 면들에 포함되는 보로노이 다이어그램의 꼭지점들과 맞닿는 보로노이 다이어그램의 면 또는 보로노이 다이어그램의 모서리에 대해 모서리 플리핑 이벤트와 면 플리핑 이벤트 발생을 재계산하고,
재계산된 충돌 이벤트와 모서리 플리핑 이벤트와, 면 플리핑 이벤트의 발생시간이 빠른 순으로, 재계산된 충돌 이벤트를 발생시키는 이동 구들 간에, 재계산된 모서리 플리핑 이벤트를 발생시키는 이동 구들 간에, 그리고 재계산된 면 이벤트를 발생시키는 이동 구들 간에 실제 충돌여부를 재계산하는 단계를 더 포함하되,
상기 충돌 이벤트가 발생된 보로노이 다이어그램의 정보의 업데이트는, 상기 이동체들의 모니터링 시간 구간 동안 반복되며, 상기 모서리 플리핑 이벤트와 상기 면 플리핑 이벤트와 상기 충돌 이벤트가 모두 발생되지 않을 경우 종료되는 이동체들 사이의 충돌 예측 및 회피 방법.The method of claim 11,
The method may further include updating information of the Voronoi diagram in which the collision event occurred.
Recalculate collision event occurrences for the pair of moving spheres generating the collision event and other moving spheres defining the pair of moving spheres and the faces of the Voronoi diagram,
An edge flipping event for a face of a Voronoi diagram or an edge of a Voronoi diagram that abuts vertices of a Voronoi diagram included in the faces of the Voronoi diagram defined by the pair of moving spheres and the other moving spheres; Recalculate face flipping event occurrences,
Between the recomputed collision events and the edge flipping event, and the moving spheres that generate the recalculated collision event in the order of occurrence of the face flipping event in the fastest order, between the moving spheres that generate the recalculated edge flipping event, And recalculating the actual collision between the moving spheres generating the recalculated plane event.
The updating of information of the Voronoi diagram in which the collision event is generated is repeated during the monitoring time interval of the moving bodies and ends when the edge flipping event, the surface flipping event and the collision event do not occur. Collision prediction and avoidance method between.
상기 3차원 구를 생성하는 단계는 상기 오브젝트들 각각을 외접하는 구를 생성하는 이동체들 사이의 충돌 예측 및 회피 방법.The method of claim 11,
The generating of the three-dimensional sphere may include collision prediction and avoidance between moving objects generating spheres that circumscribe each of the objects.
상기 이동 구들을 생성하는 단계는 수학식 1에 의해 상기 이동 구들의 반경을 결정하는 이동체들 사이의 충돌 예측 및 회피 방법.
[수학식 1]
R = r +Vmax· tp +δ
(여기서, R은 이동 구들의 반경, r은 3차원 구의 반경, Vmax는 이동체의 최대 속도, tp 는 이동체들의 충돌 및 근접관계의 예측을 위한 계산시간, δ는 안전계수)The method of claim 11,
The generating of the moving spheres is a collision prediction and avoidance method between moving objects that determine the radius of the moving sphere by the equation (1).
[Equation 1]
R = r + V maxt p + δ
(Where R is the radius of the moving sphere, r is the radius of the three-dimensional sphere, V max is the maximum velocity of the moving object, t p is the calculation time for the prediction of collision and proximity of the moving bodies, δ is the safety factor)
상기 이동 구들간에 실제 충돌여부를 계산하는 단계는, 상기 이동 구들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계를 더 포함하는 이동체들 사이의 충돌 예측 및 회피 방법.The method of claim 11,
The calculating of the actual collision between the moving spheres further comprises the step of determining whether the objects of the moving spheres collision collision prediction and avoidance method between moving objects.
상기 이동 구들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계는,
상기 오브젝트들 각각에 내접하는 복수 개의 내접 구들로 상기 오브젝트들을 모델링하고, 상기 내접 구 단위로 상기 이동체들의 충돌을 예측하는 이동체들 사이의 충돌 예측 및 회피 방법.The method of claim 17,
Determining whether the objects of the moving spheres collide,
A method of predicting and avoiding collision between moving objects for modeling the objects with a plurality of inscribed spheres inscribed in each of the objects, and predicting collision of the moving bodies in units of the inscribed spheres.
상기 이동 구들의 상기 오브젝트들이 충돌하는지 여부를 판단하는 단계는,
상기 이동체들의 비선형 이동경로를 복수 개의 선형 이동 경로로 근사화하고, 근사화된 상기 선형 이동 경로상에서 상기 이동체들의 방향전환 위치 및 각도 를 알고 있는 경우, 상기 방향전환 위치 및 각도에서 방향전환된 상기 오브젝트들을 포함하는 기하학적 형상으로 상기 오브젝트들을 모델링하고,
상기 기하학정 형상들의 충돌을 예측하는 이동체들 사이의 충돌 예측 및 회피 방법.The method of claim 17,
Determining whether the objects of the moving spheres collide,
Approximating the non-linear movement path of the moving objects to a plurality of linear moving paths, and if the direction and position of the moving objects are known on the approximated linear moving path, the objects are redirected at the turning position and angle. Model the objects in a geometric shape,
A collision prediction and avoidance method between moving bodies for predicting collision of the geometries.
상기 이동체들은 각각의 궤도를 따라 이동하며,
상기 이동 구들 간에 실제 충돌 여부를 계산하는 단계는, 상기 보로노이 다이어그램의 면에 가장 인접한 상기 구들을 충돌 예상 물체들로 추출하고, 상기 충돌 예상 물체들의 이동 속도를 분석하여 상기 충돌 예상 물체들의 충돌 여부를 판단하는 이동체들 사이의 충돌 예측 및 회피 방법.The method of claim 11,
The moving bodies move along their respective trajectories,
The calculating of the actual collision between the moving spheres may include extracting the spheres closest to the plane of the Voronoi diagram as collision prediction objects and analyzing the movement speed of the collision prediction objects to determine whether the collision prediction objects collide with each other. Collision prediction and avoidance method between moving objects to determine.
상기 이동 구들의 궤도를 n개의 직선 구간으로 근사화하여 제1 근사 궤도를 생성하고, 상기 이동 구들의 궤도와 상기 제1 근사 궤도 간의 오차를 반영하여 상기 이동 구들의 크기를 1차 보정하고, 크기가 1차 보정된 이동 구들 간의 충돌 여부를 판단하는 이동 구들의 1차 충돌 여부 판단 단계; 및
상기 이동 구들의 1차 충돌 여부 판단 단계에서 상기 크기가 1차 보정된 이동 구들 간에 충돌이 발생될 경우, 상기 이동 구들의 궤도를 상기 n개보다 큰 m개의 직선 구간으로 근사화하여 제 2 근사 궤도를 생성하고, 상기 이동 구들의 궤도와 상기 제2 근사 궤도 간의 오차를 반영하여 상기 이동 구들의 크기를 2차 보정하고, 크기가 2차 보정된 이동 구들 간의 충돌 여부를 판단하는 이동 구들의 2차 충돌 여부 판단 단계를 포함하되,
상기 이동 구들의 1차 충돌 여부 판단 단계 및 상기 이동 구들의 2차 충돌 여부 판단 단계 각각은,
크기가 보정된 이동 구들 간의 다이어그램을 연산하여 보로노이 다이어그램의 면들을 산출하는 보로노이 다이어그램의 면 산출 단계;
상기 크기가 보정된 이동 구들 중 상기 보로노이 다이어그램의 면과 가장 인접한 이동 구들을 충돌 예상 물체들로 추출하는 충돌 예상 물체 추출 단계; 및
상기 충돌 예상 물체들의 이동 속도를 분석하여 충돌 여부를 판단하는 충돌 여부 판단 단계를 포함하는 이동체들 사이의 충돌 예측 및 회피 방법.The method of claim 20,
By approximating the trajectories of the moving spheres to n straight sections, a first approximate trajectory is generated, and the size of the moving spheres is firstly corrected by reflecting an error between the trajectories of the moving spheres and the first approximate trajectory. Determining a primary collision of the moving spheres to determine whether the primary spheres are collided with each other; And
When collision occurs between the first-corrected moving spheres in the first collision determination step of the moving spheres, a second approximate orbit is obtained by approximating the trajectories of the moving spheres to m linear sections larger than n. A second collision of the moving spheres to generate a second correction of the size of the moving spheres by reflecting an error between the trajectories of the moving spheres and the second approximate orbit, and to determine whether the collisions between the second-corrected moving spheres are determined. Includes determining whether or not
Each of the first and second collision determination step of the moving sphere and the second collision determination step of the moving sphere,
Calculating a diagram between the corrected moving spheres and calculating the planes of the Voronoi diagram;
A collision prediction object extraction step of extracting, as collision prediction objects, moving spheres closest to the plane of the Voronoi diagram among the corrected moving spheres; And
Collision prediction and avoidance method comprising a collision determination step of determining whether the collision by analyzing the movement speed of the collision prediction object.
상기 이동 구들 간에 실제 충돌 여부를 계산하는 단계는,
상기 충돌 예상 물체들 중 제1 충돌 예상 물체(A)와 제2 충돌 예상 물체(B)의 반경이 각각 rA, rB이고, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)의 제1 기준 시점에서의 중심점 위치가 각각 (Ax, Ay, Az), (Bx, By, Bz)이고, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)가 상기 궤도를 따라 이동하는 속도가 각각 VA=(vx, vy, vz), UB=(ux, uy, uz) 일 때,
t 시간 경과 후 상기 제1 충돌 예상 물체(A)의 예상 위치를 A(t), 상기 제2 충돌 예상 물체(B)의 예상 위치를 B(t)라 할 경우, 상기 제1 충돌 예상 물체(A)와 상기 제2 충돌 예상 물체(B)의 충돌 여부는 하기 수학식 2를 통해 연산되는 이동체들 사이의 충돌 예측 및 회피 방법.
[수학식 2]
(rx는 Ax-Bx, ry는 Ay-By, rz는 Az-Bz, wx는 vx-ux, wy는 vy-uy, wz는 vz-uz)The method of claim 20,
Calculating whether or not the actual collision between the moving spheres,
The radiuses of the first collision prediction object A and the second collision prediction object B among the collision prediction objects are r A and r B , respectively, and the first collision prediction object A and the second collision prediction object are respectively. The center point positions at the first reference time point of (B) are (A x , A y , A z ), (B x , B y , B z ), respectively, and the first collision predicted object A and the second are When the velocity at which the collision predicted object B moves along the trajectory is V A = (v x , v y , v z ) and U B = (u x , u y , u z ),
When the estimated position of the first collision predicted object A is t (t) and the expected position of the second collision predicted object B is t (t) after a time elapses, the first collision predicted object ( The collision prediction between the moving objects A) and the second collision predicted object (B) is calculated by the following equation (2).
[Equation 2]
(r x is A x -B x , r y is A y -B y , r z is A z -B z , w x is v x -u x , w y is v y -u y , w z is v z- u z )
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020180060257A KR102088101B1 (en) | 2018-05-28 | 2018-05-28 | Method for predicting and avoiding collision and conflict/conjunction among moving objects |
PCT/KR2018/006052 WO2018221915A1 (en) | 2017-05-30 | 2018-05-29 | Method for predicting collision and avoiding conflict between multiple moving bodies |
US16/618,271 US11508248B2 (en) | 2017-05-30 | 2018-05-29 | Method for predicting collision and avoiding conflict between multiple moving bodies |
EP18808957.7A EP3633528A4 (en) | 2017-05-30 | 2018-05-29 | Method for predicting collision and avoiding conflict between multiple moving bodies |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020180060257A KR102088101B1 (en) | 2018-05-28 | 2018-05-28 | Method for predicting and avoiding collision and conflict/conjunction among moving objects |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020190134480A Division KR102067363B1 (en) | 2019-10-28 | 2019-10-28 | Method for predicting and avoiding collision and conflict/conjunction among moving objects |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20190135157A true KR20190135157A (en) | 2019-12-06 |
KR102088101B1 KR102088101B1 (en) | 2020-03-11 |
Family
ID=68836935
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020180060257A KR102088101B1 (en) | 2017-05-30 | 2018-05-28 | Method for predicting and avoiding collision and conflict/conjunction among moving objects |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102088101B1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023229287A1 (en) * | 2022-05-23 | 2023-11-30 | 김한익 | Method and apparatus for determining collision candidate object, and computer-readable storage medium |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20080024529A (en) * | 2005-06-22 | 2008-03-18 | 한양대학교 산학협력단 | Beta-shape:compact structure for topology among spheres defining blending surface of sphere set and method of constructing same |
KR20120089517A (en) * | 2010-12-15 | 2012-08-13 | 한국항공우주연구원 | System and Method for Collision Risk Management between Satellite and Space Debris |
KR20140084813A (en) * | 2012-12-27 | 2014-07-07 | 이화여자대학교 산학협력단 | Apparatus and method for generating bounding volume using intersection of spheres |
KR101533946B1 (en) * | 2015-03-16 | 2015-07-03 | 한양대학교 산학협력단 | Methods for updating voronoi diagram of circle, method for inter-particle collision using the same |
-
2018
- 2018-05-28 KR KR1020180060257A patent/KR102088101B1/en active IP Right Grant
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20080024529A (en) * | 2005-06-22 | 2008-03-18 | 한양대학교 산학협력단 | Beta-shape:compact structure for topology among spheres defining blending surface of sphere set and method of constructing same |
KR20120089517A (en) * | 2010-12-15 | 2012-08-13 | 한국항공우주연구원 | System and Method for Collision Risk Management between Satellite and Space Debris |
KR20140084813A (en) * | 2012-12-27 | 2014-07-07 | 이화여자대학교 산학협력단 | Apparatus and method for generating bounding volume using intersection of spheres |
KR101533946B1 (en) * | 2015-03-16 | 2015-07-03 | 한양대학교 산학협력단 | Methods for updating voronoi diagram of circle, method for inter-particle collision using the same |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023229287A1 (en) * | 2022-05-23 | 2023-11-30 | 김한익 | Method and apparatus for determining collision candidate object, and computer-readable storage medium |
Also Published As
Publication number | Publication date |
---|---|
KR102088101B1 (en) | 2020-03-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102067363B1 (en) | Method for predicting and avoiding collision and conflict/conjunction among moving objects | |
US11508248B2 (en) | Method for predicting collision and avoiding conflict between multiple moving bodies | |
Charrow et al. | Information-theoretic mapping using cauchy-schwarz quadratic mutual information | |
Otsu et al. | Fast approximate clearance evaluation for rovers with articulated suspension systems | |
Nuske et al. | Autonomous exploration and motion planning for an unmanned aerial vehicle navigating rivers | |
Yang et al. | Autonomous free flight operations in urban air mobility with computational guidance and collision avoidance | |
Conde et al. | Conflict detection and resolution method for cooperating unmanned aerial vehicles | |
US8229716B2 (en) | Fast tracking methods and systems for air traffic modeling using a Monotonic Lagrangian Grid | |
Abramson et al. | The generic resolution advisor and conflict evaluator (GRACE) for detect-and-avoid (daa) systems | |
Kemna et al. | Adaptive informative sampling with autonomous underwater vehicles: Acoustic versus surface communications | |
CN114237256B (en) | Three-dimensional path planning and navigation method suitable for under-actuated robot | |
CN110793522A (en) | Flight path planning method based on ant colony algorithm | |
KR102088101B1 (en) | Method for predicting and avoiding collision and conflict/conjunction among moving objects | |
Hu et al. | UAS conflict resolution in continuous action space using deep reinforcement learning | |
Serrano | A bayesian framework for landing site selection during autonomous spacecraft descent | |
Başpınar et al. | Optimization-based autonomous air traffic control for airspace capacity improvement | |
Papaioannou et al. | Uav-based receding horizon control for 3d inspection planning | |
Ghosh et al. | Probabilistic kinematic state estimation for motion planning of planetary rovers | |
Kim et al. | Real-time path planning to dispatch a mobile sensor into an operational area | |
Abramson et al. | The Generic Resolution Advisor and Conflict Evaluator (GRACE) for Unmanned Aircraft Detect-And-Avoid Systems | |
CN115731747A (en) | Low-altitude multi-unmanned aerial vehicle probability type conflict detection method and storage medium | |
Keong et al. | Reinforcement learning for autonomous aircraft avoidance | |
US20230316924A1 (en) | Method and device for determining a collision probability of a vehicle with an object in a three-dimensional space | |
Berntorp et al. | Particle filtering for automotive: A survey | |
Lee et al. | Risk-aware trajectory planning using energy-based analysis for aerial vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
E902 | Notification of reason for refusal | ||
A107 | Divisional application of patent | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant |