KR102125259B1 - Apparatus and method for multi-copter drive control - Google Patents
Apparatus and method for multi-copter drive control Download PDFInfo
- Publication number
- KR102125259B1 KR102125259B1 KR1020180105102A KR20180105102A KR102125259B1 KR 102125259 B1 KR102125259 B1 KR 102125259B1 KR 1020180105102 A KR1020180105102 A KR 1020180105102A KR 20180105102 A KR20180105102 A KR 20180105102A KR 102125259 B1 KR102125259 B1 KR 102125259B1
- Authority
- KR
- South Korea
- Prior art keywords
- multicopter
- drivers
- information
- state
- control
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 63
- 230000000737 periodic effect Effects 0.000 claims description 19
- 230000004044 response Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 1
- 238000004883 computer application Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000001151 other effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C39/00—Aircraft not otherwise provided for
- B64C39/02—Aircraft not otherwise provided for characterised by special use
- B64C39/024—Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C27/00—Rotorcraft; Rotors peculiar thereto
- B64C27/006—Safety devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C27/00—Rotorcraft; Rotors peculiar thereto
- B64C27/04—Helicopters
- B64C27/08—Helicopters with two or more rotors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U10/00—Type of UAV
- B64U10/10—Rotorcrafts
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U30/00—Means for producing lift; Empennages; Arrangements thereof
- B64U30/20—Rotors; Rotor supports
-
- B64C2201/024—
-
- B64C2201/108—
-
- B64C2201/14—
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D45/00—Aircraft indicators or protectors not otherwise provided for
- B64D2045/0085—Devices for aircraft health monitoring, e.g. monitoring flutter or vibration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U2201/00—UAVs characterised by their flight controls
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Mechanical Engineering (AREA)
- Remote Sensing (AREA)
- Safety Devices In Control Systems (AREA)
Abstract
본원은 멀티콥터 구동 제어 장치 및 방법에 관한 것으로, 본원의 일 실시예에 따른 복수의 구동기를 갖는 멀티콥터의 구동을 제어하는 방법에 있어서, (a) 상기 복수의 구동기 중 하나 이상의 고장 발생시 상기 멀티콥터로부터 고장 구동기의 개수에 관한 정보를 포함하는 고장 정보를 수집하는 단계, (b) 수집된 상기 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 상기 멀티콥터의 제어정보를 생성하는 단계 및 (c) 생성된 상기 제어정보에 따라 상기 멀티콥터의 구동을 제어하는 단계를 포함하고, 상기 고장 감내 알고리즘은, 전체 구동기의 개수와 대비한 상기 고장 구동기의 개수에 기초하여 상기 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하여 결정될 수 있다.The present invention relates to a multicopter driving control apparatus and method, in a method for controlling the driving of a multicopter having a plurality of actuators according to an embodiment of the present application, (a) when the failure of one or more of the plurality of actuators, the multi Collecting fault information including information on the number of fault drivers from the copter, (b) generating control information of the multicopter based on a fault tolerance algorithm corresponding to the collected fault information; and (c) And controlling the operation of the multicopter according to the generated control information, wherein the fault tolerance algorithm is based on the number of the faulty drivers compared to the total number of drivers, and the multicopter is capable of full control and It can be determined by determining which of the states in which partial control power is possible.
Description
본원은 멀티콥터 구동 제어 장치(시스템) 및 방법에 관한 것이다.The present invention relates to a multicopter drive control device (system) and method.
일반적으로 멀티콥터(Multi-Copter)는 사람이 직접 탑승하여 조종하지 않고 무선을 비행하는 항공기를 의미하며, 최근 들어 항공 촬영이나 물건 운반 등 다양한 용도로 멀티콥터가 활용되고 있어, 그 시장이 급증하고 있다. 이러한 수요와 함께 멀티콥터 사고도 증가하면서 안전 운용에 대한 요구가 높아지고 있다.In general, multi-copter (Multi-Copter) refers to an aircraft that does not maneuver in person and fly wirelessly. Recently, multi-copters have been used for various purposes such as aerial photography or transporting objects, and the market is rapidly increasing. have. Along with these demands, multicopter accidents are increasing, and the demand for safe operation is increasing.
이에 발맞추어 멀티콥터의 안전운용을 위한 연구들도 많이 이루어진 반면, 대다수가 영상센서 등을 활용한 장애물 탐지 및 충돌 회피 기술이고, 비행 중에 고장이 발생하는 것과 같은 대처하기 힘들고 큰 사고가 발생할 수 있는 상황에 대비한 기술은 그 중요성에 비하여 상대적으로 주목을 받지 못하고 있다. In response to this, many studies have been conducted for safe operation of multicopters, while the majority are obstacle detection and collision avoidance technologies using image sensors, etc. Technology prepared for the situation has received relatively little attention compared to its importance.
또한, 기존 멀티콥터에 적용되는 일반적인 제어 알고리즘의 경우, 구동기 3개 이하에서 멀티콥터를 운영할 경우, 기체의 모든 상태량을 제어할 수 없어, 추락이 발생되고, 이에 따라 안전사고가 발생될 수 있는 문제점이 있다.In addition, in the case of a general control algorithm applied to an existing multicopter, when operating a multicopter with 3 or fewer actuators, all state quantities of the aircraft cannot be controlled, resulting in a fall, and thus a safety accident. There is a problem.
본원의 배경이 되는 기술은 한국등록특허공보 제1호에 개시되어 있다.The background technology of this application is disclosed in Korean Registered Patent Publication No. 1.
본원은 전술한 종래 기술의 문제점을 해결하기 위한 것으로서, 고장 감내 알고리즘을 적용함으로써 요축을 포기한 채 나머지 상태량을 제어할 수 있어 안전지대로 착륙이 가능하고 안전사고를 방지할 수 있는 멀티콥터 구동 제어 장치 및 방법을 제공하는 것으로 목적으로 한다.The present application is to solve the problems of the prior art described above, by applying a fault-tolerant algorithm, it is possible to control the rest of the state while abandoning the yaw axis, so that a multicopter-driven control device capable of landing in a safety zone and preventing a safety accident It is an object to provide a method and.
다만, 본원의 실시예가 이루고자 하는 기술적 과제는 상기된 바와 같은 기술적 과제들로 한정되지 않으며, 또 다른 기술적 과제들이 존재할 수 있다.However, the technical problems to be achieved by the embodiments of the present application are not limited to the technical problems as described above, and other technical problems may exist.
상기한 기술적 과제를 달성하기 위한 기술적 수단으로서, 본원의 일 실시예에 따른 멀티콥터 구동 제어 방법은, 복수의 구동기를 갖는 멀티콥터의 구동을 제어하는 방법에 있어서, (a) 상기 복수의 구동기 중 하나 이상의 고장 발생시 상기 멀티콥터로부터 고장 구동기의 개수에 관한 정보를 포함하는 고장 정보를 수집하는 단계, (b) 수집된 상기 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 상기 멀티콥터의 제어정보를 생성하는 단계 및 (c) 생성된 상기 제어정보에 따라 상기 멀티콥터의 구동을 제어하는 단계를 포함하고, 상기 고장 감내 알고리즘은, 전체 구동기의 개수와 대비한 상기 고장 구동기의 개수에 기초하여 상기 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하여 결정될 수 있다As a technical means for achieving the above technical problem, a multicopter driving control method according to an embodiment of the present application is a method for controlling driving of a multicopter having a plurality of drivers, (a) among the plurality of drivers Collecting fault information including information on the number of fault drivers from the multicopter when one or more faults occur, (b) generating control information of the multicopter based on a fault tolerance algorithm corresponding to the collected fault information And (c) controlling the operation of the multicopter according to the generated control information, wherein the fault tolerant algorithm is based on the number of the faulty drivers compared to the total number of drivers. Can be determined by judging which of the fully controllable and partially controllable states
본원의 일 실시예에 따르면, 상기 부분적 제어력 가능 상태는, 상기 완전 제어력 가능 상태보다 구동기의 고장이 확산되어 고장 구동기의 개수가 증가된 상태일 수 있다.According to the exemplary embodiment of the present application, the partial controllable state may be a state in which the failure of the driver is diffused and the number of faulty drivers is increased than the fully controllable state.
본원의 일 실시예에 따르면, 상기 (a) 단계 내지 상기 (c) 단계는 반복적으로 수행되고, 상기 (b) 단계에서, 상기 고장 구동기의 개수가 제1 개수에 도달하면, 상기 멀티콥터가 상기 완전 제어력 가능 상태인 것으로 판단하고, 상기 고장 구동기의 개수가 상기 제1 개수보다 큰 제2 개수에 도달하면, 상기 멀티콥터가 상기 완전 제어력 가능 상태에서 상기 부분적 제어력 가능 상태로 변경된 것으로 판단할 수 있다.According to an embodiment of the present application, steps (a) to (c) are repeatedly performed, and in step (b), when the number of the faulty drivers reaches a first number, the multicopter is When it is determined that the controllability is possible, and when the number of the faulty drivers reaches the second number greater than the first number, it may be determined that the multicopter is changed from the controllable state to the partial controllable state. .
본원의 일 실시예에 따르면, 상기 (b) 단계는, 상기 (a) 단계에서 수집된 상기 고장 구동기의 개수가 증가되면, 상기 고장 구동기의 증가된 개수에 대응하여 상기 제어정보를 업데이트할 수 있다.According to an embodiment of the present application, in step (b), when the number of the fault drivers collected in step (a) is increased, the control information may be updated in response to the increased number of fault drivers. .
본원의 일 실시예에 따르면, 상기 (b) 단계는, 상기 복수의 구동기 중 잔여하는 정상 구동기의 개수보다 1개 적은 개수의 정상 구동기에서 발생될 수 있는 최대추력의 합과 상기 멀티콥터의 무게를 비교하고, 상기 최대추력의 합이 상기 멀티콥터의 무게보다 클 경우 상기 (a) 단계에서 수집된 상기 고장 구동기의 개수가 1개 더 증가되더라도 상기 고장 구동기의 증가된 개수에 대응하는 고장 감내 알고리즘에 따라 상기 제어정보를 업데이트하고, 상기 최대추력의 합이 상기 멀티콥터의 무게보다 작을 경우 상기 (a) 단계에서 수집된 상기 고장 구동기의 개수가 1개 더 증가되기 전에 상기 고장 구동기의 증가 전 개수에 대응하는 고장 감내 알고리즘에 따라 안전착륙을 수행할 수 있다.According to an embodiment of the present application, the step (b) is the sum of the maximum thrust and the weight of the multicopter that can be generated in one less number of normal drivers than the number of remaining normal drivers among the plurality of drivers. In comparison, when the sum of the maximum thrust is greater than the weight of the multicopter, even if the number of the faulty drivers collected in step (a) is increased by one more, to the fault tolerance algorithm corresponding to the increased number of the faulty drivers. Accordingly, when the control information is updated, and the sum of the maximum thrust is less than the weight of the multicopter, the number of the failed drivers collected in step (a) is increased to the number before the increase of the failed drivers. Safe landing can be performed according to the corresponding fault tolerance algorithm.
본원의 일 실시예에 따르면, 상기 (b) 단계에서, 상기 전체 구동기의 개수가 6개 이상이면, 상기 복수의 구동기 중 하나 이상의 고장 발생시 상기 고장 구동기의 개수에 기초하여 상기 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하고, 상기 전체 구동기의 개수가 6개 미만이면, 상기 복수의 구동기 중 하나 이상의 고장 발생시 상기 고장 구동기의 개수와 무관하게 상기 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단할 수 있다.According to an embodiment of the present application, in the step (b), if the total number of drivers is 6 or more, the multicopter is capable of full control based on the number of the faulty drivers when one or more of the plurality of drivers fail. It is determined which of the states and the partial controllability is possible, and if the total number of actuators is less than six, the multicopter is in a partial controllable state regardless of the number of faulty drivers when one or more of the plurality of actuators fail. You can judge that.
본원의 일 실시예에 따르면, 상기 (b) 단계에서, 상기 멀티콥터가 상기 완전 제어력 가능 상태인 것으로 판단되면, 고장 감내 알고리즘으로 PI Method(Pseudo Inverse Method)를 적용할 수 있다.According to an embodiment of the present application, in the step (b), if it is determined that the multicopter is in the state of full control, it is possible to apply a PI Method (Pseudo Inverse Method) as a fault tolerance algorithm.
본원의 일 실시예에 따르면, 상기 PI Method는, 상기 멀티콥터의 추락 방지를 위해 상기 복수의 구동기 중 잔여하는 정상 구동기의 요구 회전속도를 상기 멀티콥터의 추력 및 회전 병렬 관계식을 통해 유도하여 적용하는 알고리즘일 수 있다.According to an embodiment of the present application, the PI Method, by applying the required rotational speed of the normal driver remaining among the plurality of actuators to prevent the multicopter from falling through the multi-copter thrust and rotation parallel relation to apply It can be an algorithm.
본원의 일 실시예에 따르면, 상기 (b) 단계에서, 상기 멀티콥터가 상기 부분적 제어력 가능 상태인 것으로 판단되면, 고장 감내 알고리즘으로 Periodic Solution을 적용할 수 있다.According to one embodiment of the present application, in step (b), if it is determined that the multicopter is in the state capable of partially controlling, a periodic solution may be applied as a fault tolerance algorithm.
본원의 일 실시예에 따르면, 상기 Periodic Solution은, 상기 멀티콥터의 요축 제어를 포기하면서 기체방향 벡터, 각속도 및 위치를 제어함으로써 상기 멀티콥터의 추락을 방지하면서 안전착륙을 수행하는 알고리즘일 수 있다.According to one embodiment of the present application, the Periodic Solution may be an algorithm that performs safe landing while preventing the multicopter from falling by controlling the gas direction vector, angular velocity, and position while giving up control of the yaw axis of the multicopter.
한편, 본원의 일 실시예에 따른 복수의 구동기를 갖는 멀티콥터의 구동을 제어하는 장치에 있어서, 상기 복수의 구동기 중 하나 이상의 고장 발생시 상기 멀티콥터로부터 고장 구동기의 개수에 관한 정보를 포함하는 고장 정보를 수집하는 정보 수집부, 수집된 상기 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 상기 멀티콥터의 제어정보를 생성하는 제어정보 생성부 및 생성된 상기 제어정보에 따라 상기 멀티콥터의 구동을 제어하는 구동 제어부를 포함하고, 상기 고장 감내 알고리즘은, 전체 구동기의 개수와 대비한 상기 고장 구동기의 개수에 기초하여 상기 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하여 결정될 수 있다.On the other hand, in the apparatus for controlling the driving of a multicopter having a plurality of actuators according to an embodiment of the present application, the failure information including information on the number of the failure driver from the multicopter when one or more of the plurality of actuators fails The information collection unit for collecting, the control information generating unit for generating control information of the multicopter based on the fault tolerance algorithm corresponding to the collected fault information, and controlling the operation of the multicopter according to the generated control information A driving control unit, and the fault tolerant algorithm may be determined by determining whether the multicopter is in a fully controllable state or a partial controllable state based on the number of faulty drivers compared to the total number of drivers.
본원의 일 실시예에 따른 멀티콥터 구동 제어 방법은 컴퓨터에서 실행하기 위한 프로그램을 기록한 컴퓨터에서 판독 가능한 기록매체에 저장될 수 있다.The multi-copter driving control method according to an embodiment of the present application may be stored in a computer-readable recording medium recording a program for execution on a computer.
상술한 과제 해결 수단은 단지 예시적인 것으로서, 본원을 제한하려는 의도로 해석되지 않아야 한다. 상술한 예시적인 실시예 외에도, 도면 및 발명의 상세한 설명에 추가적인 실시예가 존재할 수 있다.The above-described problem solving means are merely exemplary and should not be construed as limiting the present application. In addition to the exemplary embodiments described above, additional embodiments may exist in the drawings and detailed description of the invention.
전술한 본원의 과제 해결 수단에 의하면, 고장 감내 알고리즘을 적용함으로써 요축을 포기한 채 나머지 상태량을 제어할 수 있어 안전지대로 착륙이 가능하고 안전사고를 방지할 수 있는 멀티콥터 구동 제어 장치 및 방법이 제공될 수 있다. According to the above-described problem solving means of the present application, a multicopter driving control device and method are provided that can land on a safety zone and prevent safety accidents by applying a fault-tolerance algorithm to control the remaining state amount while abandoning the yaw axis. Can be.
다만, 본원에서 얻을 수 있는 효과는 상기된 바와 같은 효과들로 한정되지 않으며, 또 다른 효과들이 존재할 수 있다.However, the effects obtainable herein are not limited to the above-described effects, and other effects may exist.
도 1은 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치의 개략적인 구성도이다.
도 2는 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 쿼드콥터의 동작 흐름을 나타낸 도면이다.
도 3은 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 헥사콥터의 동작 흐름을 나타낸 도면이다.
도 4는 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 제어정보를 업데이트 하기 위한 동작 흐름을 나타낸 도면이다.
도 5는 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 옥타콥터의 동작 흐름을 나타낸 도면이다.
도 6은 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 멀티콥터의 전체적인 동작 흐름을 나타낸 도면이다.
도 7은 본원의 일 실시예에 따른 멀티콥터 구동 제어 방법에 대한 동작 흐름도이다.1 is a schematic configuration diagram of a multicopter driving control apparatus according to an embodiment of the present application.
2 is a view showing an operation flow of a quadcopter in a multicopter driving control apparatus and method according to an embodiment of the present application.
3 is a view showing an operation flow of a hexacopter in a multicopter driving control apparatus and method according to an embodiment of the present application.
4 is a diagram illustrating an operation flow for updating control information in a multicopter driving control apparatus and method according to an embodiment of the present application.
5 is a view showing an operation flow of an octacopter in a multicopter driving control apparatus and method according to an embodiment of the present application.
6 is a view showing the overall operation flow of a multicopter in a multicopter driving control apparatus and method according to an embodiment of the present application.
7 is an operation flowchart for a multicopter driving control method according to an embodiment of the present application.
아래에서는 첨부한 도면을 참조하여 본원이 속하는 기술 분야에서 통상의 지식을 가진 자가 용이하게 실시할 수 있도록 본원의 실시예를 상세히 설명한다. 그러나 본원은 여러 가지 상이한 형태로 구현될 수 있으며 여기에서 설명하는 실시예에 한정되지 않는다. 그리고 도면에서 본원을 명확하게 설명하기 위해서 설명과 관계없는 부분은 생략하였으며, 명세서 전체를 통하여 유사한 부분에 대해서는 유사한 도면 부호를 붙였다.Hereinafter, embodiments of the present application will be described in detail with reference to the accompanying drawings so that those skilled in the art to which the present application pertains may easily practice. However, the present application may be implemented in various different forms and is not limited to the embodiments described herein. In addition, in order to clearly describe the present application in the drawings, parts irrelevant to the description are omitted, and like reference numerals are assigned to similar parts throughout the specification.
본원 명세서 전체에서, 어떤 부분이 다른 부분과 "연결"되어 있다고 할 때, 이는 "직접적으로 연결"되어 있는 경우뿐 아니라, 그 중간에 다른 소자를 사이에 두고 "전기적으로 연결" 또는 "간접적으로 연결"되어 있는 경우도 포함한다. Throughout this specification, when a part is "connected" to another part, it is not only "directly connected", but also "electrically connected" or "indirectly connected" with another element in between. "It also includes the case where it is.
본원 명세서 전체에서, 어떤 부재가 다른 부재 "상에", "상부에", "상단에", "하에", "하부에", "하단에" 위치하고 있다고 할 때, 이는 어떤 부재가 다른 부재에 접해 있는 경우뿐 아니라 두 부재 사이에 또 다른 부재가 존재하는 경우도 포함한다.Throughout the present specification, when a member is positioned on another member “on”, “on the top”, “top”, “bottom”, “bottom”, “bottom”, this means that one member is attached to another member. This includes cases where there is another member between the two members as well as when in contact.
본원 명세서 전체에서, 어떤 부분이 어떤 구성 요소를 "포함"한다고 할 때, 이는 특별히 반대되는 기재가 없는 한 다른 구성 요소를 제외하는 것이 아니라 다른 구성 요소를 더 포함할 수 있는 것을 의미한다.Throughout this specification, when a part “includes” a certain component, it means that the component may further include other components, not to exclude other components, unless otherwise stated.
본원은 멀티콥터의 구동을 제어하는 장치(시스템) 및 방법에 관한 것이다. 보다 구체적으로, 본원은 고장 감내 알고리즘에 의해 멀티콥터의 구동을 제어하는 장치(시스템) 및 방법에 관한 것이다. 여기서 멀티콥터는, 무인항공기 또는 드론(Drone)과 같은 의미로, 3개 이상의 구동기(모터) 및 프로펠러를 가진 비행체를 의미할 수 있다.The present invention relates to an apparatus (system) and method for controlling the operation of a multicopter. More specifically, the present disclosure relates to an apparatus (system) and method for controlling the operation of a multicopter by a fault tolerance algorithm. Here, the multicopter may mean an unmanned aerial vehicle or a drone and a vehicle having three or more actuators (motors) and propellers.
본원에 따른 멀티콥터 구동 제어 장치 및 방법은, 멀티콥터의 복수의 프로펠러를 구동시키는 각각의 구동기 중 고장 구동기가 하나 이상일 경우, 고장 감내 알고리즘을 통해 멀티콥터의 제어 상태를 판단함으로써, 멀티콥터의 추락을 방지하고, 안전지대로 안전하게 착륙할 수 있도록 하는 장치 및 방법에 관한 것이다. Multi-copter driving control apparatus and method according to the present application, when the failure of one or more of the actuators driving each of a plurality of propellers of the multicopter, by determining the control state of the multicopter through a fault tolerance algorithm, the multicopter crash It relates to a device and method for preventing, and allowing a safe landing in a safe zone.
본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에 의하면, 멀티콥터의 안전사고를 미연에 방지할 수 있으므로, 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법은 군수 및 국방 분야에서 넓은 지역에 대한 감시, 정찰, 수색 등의 작전에 적용될 수 있으며, 또한 민간에서도 멀티콥터를 이용한 조난자 수색, 물류 운송사업 등의 분야에서 활용될 수 있다. 다만, 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법의 적용 분야는 이에만 한정되는 것은 아니다.According to the multicopter driving control apparatus and method according to an embodiment of the present application, since a safety accident of the multicopter can be prevented in advance, the multicopter driving control apparatus and method according to an embodiment of the present application may be used in the military and defense fields. It can be applied to operations such as surveillance, reconnaissance, and search for large areas, and it can also be used in the fields of multi-copter search for distressed persons and logistics transportation. However, the application fields of the multicopter driving control apparatus and method according to an embodiment of the present application are not limited thereto.
본원의 실시예를 설명하기에 앞서, 용이한 이해를 위해 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치를 먼저 설명한 후, 멀티콥터 구동 제어 방법을 설명하기로 한다.Prior to describing the embodiments of the present application, for ease of understanding, a multicopter driving control device according to an embodiment of the present application will be first described, and then a multicopter driving control method will be described.
도 1은 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치의 구성을 도시한 도면이다.1 is a view showing the configuration of a multi-copter drive control apparatus according to an embodiment of the present application.
도 1을 참조하면, 멀티콥터 구동 제어 장치(100)는, 정보 수집부(110), 제어정보 생성부(120) 및 구동 제어부(130)를 포함할 수 있다.Referring to FIG. 1, the multicopter
정보 수집부(110)는, 복수의 구동기 중 하나 이상의 고장 발생시 멀티콥터로부터 고장 구동기의 개수에 관한 정보를 포함하는 고장 정보를 수집할 수 있다.The
여기서 구동기는, 멀티콥터의 프로펠러를 제어하는 모터를 포함한 구동 장치를 의미할 수 있으며, 구동기는 배터리(battery)나 컨트롤러를 포함한 멀티콥터가 비행하기 위해 필요한 부품의 작동에 의해 구동될 수 있다. 여기서, 멀티콥터(Multi-Copter)는, 드론을 포함한 무인 비행체(UAV; Unmanned Aerial Vehicle)를 지칭하는 넓은 개념으로 이해될 수 있다. 복수의 구동기는, 멀티콥터에 구비된 복수의 프로펠러를 제어하는 구동 장치의 전체를 의미할 수 있다. 일 예로, 4개의 프로펠러가 구비된 쿼드콥터(Quad-Copter)는 4개의 구동기를 가질 수 있고, 6개의 프로펠러가 구비된 헥사콥터(Hexa-Copter)는 6개의 구동기를 가질 수 있으며, 8개의 프로펠러가 구비된 옥타콥터(Octa-Copter)는 8개의 구동기를 가질 수 있다.Here, the driver may mean a driving device including a motor that controls a propeller of a multicopter, and the driver may be driven by operation of a component required for a multicopter including a battery or a controller to fly. Here, the multi-copter (Multi-Copter) can be understood as a broad concept referring to an unmanned aerial vehicle (UAV) including a drone. The plurality of drivers may mean the entire driving device for controlling the plurality of propellers provided in the multicopter. For example, a quad-copter equipped with four propellers may have four drivers, and a hexacopter equipped with six propellers may have six drivers, and eight propellers Octa-Copter equipped with may have eight actuators.
복수의 구동기가 구동되면, 멀티콥터의 프로펠러가 회전하면서 추력이 발생되고, 멀티콥터는 xyz 좌표계에서 3축으로 운동할 수 있다. 이때, x축을 중심으로 멀티콥터가 좌우로 회전하는 것을 롤링(rolling) 운동이라 하고, y축을 중심으로 멀티콥터가 앞뒤로 회전하는 것을 피칭(pitching) 운동이라 하며, z축을 중심으로 멀티콥터가 회전하는 것을 요잉(yawing) 운동이라 할 수 있다.When a plurality of drivers are driven, thrust is generated while the propeller of the multicopter rotates, and the multicopter can move in three axes in the xyz coordinate system. At this time, the rotation of the multicopter around the x-axis from side to side is called a rolling motion, and the rotation of the multicopter back and forth around the y-axis is called a pitching motion, and the multicopter rotates around the z-axis. This can be called a yawing exercise.
정보 수집부(110)는, 복수의 구동기 중 하나 이상의 고장 발생시 멀티콥터로부터 고장 구동기의 개수에 관한 정보를 포함하는 고장 정보를 수집할 수 있으며, 여기서 정보 수집부(110)는, 멀티콥터와 네트워크를 통해 통신할 수 있다. 상기 네트워크의 일 예에는 3GPP(3rd Generation Partnership Project) 네트워크, LTE(Long Term Evolution) 네트워크, 5G 네트워크, WIMAX(World Interoperability for Microwave Access) 네트워크, 인터넷(Internet), LAN(Local Area Network), Wireless LAN(Wireless Local Area Network), WAN(Wide Area Network), PAN(Personal Area Network), 블루투스(Bluetooth) 네트워크, Wi-fi네트워크, 위성 방송 네트워크, 아날로그 방송 네트워크, DMB(Digital Multimedia Broadcasting) 네트워크, 적외선 통신 등이 포함되나, 반드시 이에 한정되는 것은 아니다.The
여기서 고장 정보는, 고장 구동기의 개수에 관한 정보와 함께, 고장 구동기가 구비된 멀티콥터의 전체 구동기의 개수에 관한 정보 및 고장이 발생한 구동기 부품의 종류에 관한 정보를 더 포함할 수 있다. 따라서 정보 수집부(110)는 고장 구동기의 개수에 관한 정보 및 고장 구동기가 구비된 멀티콥터의 전체 구동기 개수에 관한 정보를 포함한 고장 정보를 수집할 수 있다. Here, the failure information may further include information on the number of actuators of the multicopter equipped with the failure driver, and information on the type of the actuator component where the failure has occurred, along with information on the number of failure drivers. Accordingly, the
제어정보 생성부(120)는, 수집된 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 멀티콥터의 제어정보를 생성할 수 있다. 여기서 고장 감내 알고리즘은, 전체 구동기의 개수와 대비한 고장 구동기의 개수에 기초하여 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하여 결정될 수 있다.The control
도 2는 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 쿼드콥터의 동작 흐름을 나타낸 도면이다.2 is a view showing an operation flow of a quadcopter in a multicopter driving control apparatus and method according to an embodiment of the present application.
도 2를 참조하면, 전체 구동기의 개수가 제4 개수인 쿼드콥터(Quad-Copter)가 비행 도중 구동기 고장이 발생되면, 정보 수집부(110)는 해당 쿼드콥터로부터 고장 구동기의 개수에 관한 정보를 포함한 고장 정보를 수집할 수 있다.Referring to FIG. 2, when a quad-copter having a total number of drivers is a fourth number, a driver failure occurs during flight, the
이때, 정보 수집부(110)가 수집한 고장 구동기의 개수가 제1 개수 이상일 경우, 제어정보 생성부(120)는 해당 쿼드콥터가 부분적 제어력 가능 상태인 것으로 판단 할 수 있다. 여기서 부분적 제어력 가능 상태는, 완전 제어력 가능 상태보다 구동기의 고장이 확산되어 고장 구동기의 개수가 증가된 상태일 수 있다.At this time, when the number of fault drivers collected by the
완전 제어력 가능 상태 및 부분적 제어력 가능 상태의 일 예로, 정보 수집부(110)가 수집한 고장 구동기의 개수가 제0 개수일 경우, 즉, 해당 쿼드콥터의 정상 구동기의 개수가 제 4개수일 경우, 쿼드콥터는 지속운용이 가능한 상태이므로, 제어정보 생성부(120)는 해당 쿼트콥터가 완전 제어력 가능 상태로 판단 할 수 있다. 또한, 정보 수집부(110)가 수집한 고장 구동기의 개수가 제1 개수 이상일 경우, 제어정보 생성부(120)는 해당 쿼드콥터가 부분적 제어력 가능 상태인 것으로 판단 할 수 있다.As an example of a fully controllable state and a partial controllable state, when the number of faulty drivers collected by the
즉, 정보 수집부(110)가 수집한 전체 구동기의 개수에 관한 정보가 제4 개수이고, 고장 구동기의 개수에 관한 정보가 제1 개수 이상일 경우, 제어정보 생성부(120)는 고장 감내 알고리즘에 기초하여 멀티콥터의 제어정보를 생성할 수 있는데, 이때, 해당 멀티콥터는 부분적 제어력 가능 상태인 것으로 판단될 수 있고, 부분적 제어력 가능 상태에 해당하는 고장 감내 알고리즘에 기초하여 해당 멀티콥터의 제어정보를 생성할 수 있다. That is, when the information on the total number of drivers collected by the
구체적으로 제어정보 생성부(120)는, 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단되면, 고장 감내 알고리즘으로 Periodic Solution을 적용할 수 있다. Periodic Solution은, LQR(Linear Quadratic Regulator Method) 제어 알고리즘으로, 멀티콥터의 요(yaw)축 제어를 포기하면서, 기체방향 백터, 각속도 및 위치를 제어함으로써, 멀티콥터의 추락을 방지하면서 안전착륙을 수행하는 알고리즘일 수 있다.In detail, if it is determined that the multicopter is capable of partially controlling power, the control
따라서, 제어정보 생성부(120)는, 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단되면, 해당 멀티콥터의 추락을 방지하면서 안전착륙을 수행하는 Periodic Solution을 고장 감내 알고리즘으로 적용함으로써, 멀티콥터가 안전하게 착륙할 수 있도록 한다.Therefore, when it is determined that the multicopter is capable of partially controlling power, the control
제어정보 생성부(120)는 고장 구동기의 개수가 제1 개수에 도달하면, 멀티콥터가 완전 제어력 가능 상태인 것으로 판단할 수 있고, 고장 구동기의 개수가 제1 개수보다 큰 제2 개수에 도달하면, 제어정보 생성부(120)는 멀티콥터가 완전 제어력 가능 상태에서 부분적 제어력 가능 상태로 변경된 것으로 판단할 수 있다. When the number of faulty drivers reaches the first number, the control
이때, 제어정보 생성부(120)는 정보 수집부(110)에서 수집된 고장 구동기의 개수가 증가되면, 고장 구동기의 증가된 개수에 대응하여 제어정보를 업데이트할 수 있다.At this time, the control
도 3은 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 헥사콥터의 동작 흐름을 나타낸 도면이고, 도 4는 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 제어정보를 업데이트 하기 위한 동작 흐름을 나타낸 도면이다.3 is a view showing an operation flow of a hexacopter in a multicopter driving control apparatus and method according to an embodiment of the present application, and FIG. 4 is updating control information in a multicopter driving control apparatus and method according to an embodiment of the present application It is a view showing the operation flow for.
도 3 및 도 4를 참조하면, 전체 구동기의 개수가 제6 개수인 헥사콥터(Hexa-Copter)가 비행 도중 구동기 고장이 발생되면, 정보 수집부(110)는 해당 헥사콥터로부터 고장 구동기의 개수에 관한 정보를 포함한 고장 정보를 수집할 수 있고, 제어정보 생성부(120)는 수집된 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 해당 헥사콥터의 제어정보를 생성할 수 있다.Referring to FIGS. 3 and 4, when a driver failure occurs during a flight of a six-number Hexa-Copter, the
일 예로, 정보 수집부(110)가 헥사콥터로부터 수집한 고장 구동기의 개수에 관한 정보가 제1 개수일 경우, 제어정보 생성부(120)는 해당 헥사콥터가 완전 제어력 가능 상태인 것으로 판단 할 수 있다. 전체 구동기의 개수가 제6 개수인 헥사콥터가 비행 도중 제1 개수의 구동기가 고장날 경우, 제어정보 생성부(120)는 해당 헥사콥터가 지속 운용이 가능한 상태로 판단함에 따라, 완전 제어력 가능 상태인 것으로 판단할 수 있다.For example, when the information on the number of fault drivers collected by the
즉, 정보 수집부(110)가 멀티콥터로부터 수집한 전체 구동기의 개수에 관한 정보가 제 6 개수이고, 고장 구동기의 개수에 관한 정보가 제1 개수일 경우, 제어정보 생성부(120)는 고장 감내 알고리즘에 기초하여 멀티콥터의 제어정보를 생성할 수 있는데, 이때, 해당 멀티콥터는 완전 제어력 가능 상태인 것으로 판단될 수 있고, 완전 제어력 가능 상태에 해당하는 고장 감내 알고리즘에 기초하여 해당 멀티콥터의 제어정보를 생성할 수 있다.That is, when the
구체적으로 제어정보 생성부(120)는, 멀티콥터가 완전 제어력 가능 상태인 것으로 판단되면, 고장 감내 알고리즘으로 PI Method(Pseudo Inverse Method)를 적용할 수 있다. PI Method는, 단계적 일반화 역변환 기법(Cascaded Generalized Inverse)으로, 멀티콥터의 추락 방지를 위해 복수의 구동기 중 잔여하는 정상 구동기의 요구 회전속도를 멀티콥터의 추력 및 회전 병렬 관계식을 통해 유도하여 적용하는 알고리즘일 수 있다. Specifically, if it is determined that the multicopter is in a state capable of full control, the control
따라서, 제어정보 생성부(120)는, 멀티콥터가 완전 제어력 가능 상태인 것으로 판단되면, 해당 멀티콥터의 추락을 방지하면서 안전비행을 수행하는 PI Method를 고장 감내 알고리즘으로 적용함으로써, 해당 멀티콥터가 안전하게 비행할 수 있도록 한다.Therefore, when it is determined that the multicopter is in a fully controllable state, the control
다른 예로, 정보 수신부(110)가 헥사콥터로부터 수집한 고장 구동기의 개수에 관한 정보가 제2 개수 이상일 경우, 제어정보 생성부(120)는 해당 헥사콥터가 완전 제어력 가능 상태에서 부분적 제어력 가능 상태로 변경된 것으로 판단할 수 있다.As another example, when the information on the number of fault drivers collected by the
정보 수집부(110)가 멀티콥터로부터 수집한 전체 구동기의 개수에 관한 정보가 제6 개수이고, 구동기 1개 고장 발생 이후 1개가 추가적으로 고장이 발생한 경우, 제어정보 생성부(120)는 해당 멀티콥터가 완전 제어력 가능 상태에서 부분적 제어력 가능 상태로 변경된 것으로 판단할 수 있는데, 여기서 고장 감내 알고리즘은, 앞서 언급한 쿼드콥터에 적용된 Periodic Solution이 적용될 수 있다. If the
또 다른 예로, 정보 수신부(110)가 헥사콥터로부터 수집한 고장 구동기의 개수에 관한 정보가 제3 개수 이상일 경우, 제어정보 생성부(120)는 해당 헥사콥터가 부분적 제어력 가능 상태인 것으로 판단할 수 있다.As another example, when the information on the number of fault drivers collected by the
즉, 정보 수집부(110)가 멀티콥터로부터 수집한 전체 구동기의 개수에 관한 정보가 제6 개수이고, 구동기 2개 고장 발생 이후 1개가 추가적으로 고장이 발생한 경우, 제어정보 생성부(120)는 해당 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단할 수 있는데, 여기서 고장 감내 알고리즘은, 앞서 언급한 Periodic Solution이 적용될 수 있다.That is, if the
이때, 제어정보 생성부(120)는, 복수의 구동기 중 잔여하는 정상 구동기의 개수보다 1개 적은 개수의 정상 구동기에서 발생될 수 있는 최대추력의 합과 상기 멀티콥터의 무게를 비교할 수 있다. 만약, 상기 최대추력의 합이 멀티콥터의 무게보다 클 경우, 제어정보 생성부(120)에서 수집된 고장 구동기의 개수가 1개 더 증가되더라도 고장 구동기의 증가된 개수에 대응하는 고장 감내 알고리즘에 따라 제어정보를 업데이트하고, 최대추력의 합이 멀티콥터의 무게보다 작거나 같을 경우, 제어정보 생성부(120)에서 수집된 고장 구동기의 개수가 1개 더 증가되기 전에 고장 구동기의 증가 전 개수에 대응하는 고장 감내 알고리즘에 따라 안전착륙을 수행할 수 있다.At this time, the control
일 예로, 정보 수집부(110)가 멀티콥터로부터 수집한 전체 구동기의 개수에 대한 정보가 제6 개수이고, 구동기 제2 개수 고장 발생 이후 제1 개수가 추가적으로 고장이 발생한 경우, 제어정보 생성부(120)는, 해당 멀티콥터에 잔여하는 정상 구동기의 개수보다 제1 개수 적은 개수인 제2 개수에서 발생될 수 있는 최대추력의 합과 해당 멀티콥터의 무게를 비교할 수 있다.For example, if the
만약, 정상 구동기 제2 개수에서 발생될 수 있는 최대추력의 합이 해당 멀티콥터의 무게보다 클 경우, 제어정보 생성부(120)는 해당 멀티콥터로부터 수집된 고장 구동기의 증가된 개수에 대응하는 고장 감내 알고리즘에 따라 제어정보를 업데이트할 수 있다. 이때, 제어정보 생성부(120)는 고장 구동기의 증가된 개수에 대응하는 고장 감내 알고리즘으로 Periodic Solution을 적용할 수 있다.If, when the sum of the maximum thrust that can be generated in the second number of normal drivers is greater than the weight of the multi-copter, the control
만약, 정상 구동기 제2 개수에서 발생될 수 있는 최대추력의 합이 해당 멀티콥터의 무게보다 작거나 같을 경우, 제어정보 생성부(120)는 해당 멀티콥터로부터 수집된 고장 구동기의 개수가 제1 개수 더 증가되기 전에 고장 구동기 증가 전 개수에 대응하는 고장 감내 알고리즘에 따라 안전착륙을 수행할 수 있다. 이때, 제어정보 생성부(120)는 고장 구동기 증가 전 개수에 대응하는 고장 감내 알고리즘으로 Periodic Solution을 적용할 수 있다.If, when the sum of the maximum thrust that can be generated from the second number of normal drivers is less than or equal to the weight of the multi-copter, the control
도 5는 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 옥타콥터의 동작 흐름을 나타낸 도면이다.5 is a view showing an operation flow of an octacopter in a multicopter driving control apparatus and method according to an embodiment of the present application.
도 5를 참조하면, 전체 구동기의 개수가 제8 개수인 옥타콥터(Octa-Copter)가 비행 도중 구동기 고장이 발생되면, 정보 수집부(110)는 해당 옥타콥터로부터 고장 구동기의 개수에 관한 정보를 포함한 고장 정보를 수집할 수 있고, 제어정보 생성부(120)는 수집된 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 해당 옥타콥터의 제어정보를 생성할 수 있다.Referring to FIG. 5, when an octa-copter having an eighth number of total actuators has a driver failure during flight, the
일 예로, 정보 수집부(110)가 옥타콥터로부터 수집한 고장 구동기의 개수에 관한 정보가 제1 개수 내지 제2 개수일 경우, 제어정보 생성부(120)는 해당 옥타콥터가 완전 제어력 가능 상태인 것으로 판단할 수 있다. 즉, 전체 구동기의 개수가 제8 개수인 옥타콥터가 비행 도중 제1 개수 내지 제2 개수의 구동기가 고장날 경우, 제어정보 생성부(120)는 해당 옥타콥터가 지속 운용이 가능한 상태로 판단함에 따라, 완전 제어력 가능 상태인 것으로 판단할 수 있다.For example, when the information on the number of fault drivers collected from the octacopter by the
즉, 정보 수집부(110)가 멀티콥터로부터 수집한 전체 구동기의 개수에 관한 정보가 제8 개수이고, 고장 구동기의 개수에 관한 정보가 제1 개수 내지 제2 개수일 경우, 제어정보 생성부(120)는 고장 감내 알고리즘에 기초하여 멀티콥터의 제어정보를 생성할 수 있는데, 이때, 해당 멀티콥터는 완전 제어력 가능 상태인 것으로 판단될 수 있고, 완전 제어력 가능 상태에 해당하는 고장 감내 알고리즘에 기초하여 해당 멀티콥터의 제어정보를 생성할 수 있다. 여기서 제어정보 생성부(120)는, 멀티콥터가 완전 제어력 가능 상태인 것으로 판단되면 고장 감내 알고리즘으로 PI Method 를 적용할 수 있다.That is, when the
다른 예로, 정보 수신부(110)가 옥타콥터로부터 수집한 고장 구동기의 개수에 관한 정보가 제3 개수 이상일 경우, 제어정보 수신부(120)는 해당 옥타콥터가 완전 제어력 가능 상태에서 부분적 제어력 가능 상태로 변경된 것으로 판단할 수 있다.As another example, when the information on the number of fault drivers collected from the octacopter by the
정보 수집부(110)가 멀티콥터로부터 수집한 전체 구동기의 개수에 관한 정보가 제8 개수이고, 구동기 2개 고장 발생 이후 1개가 추가적으로 고장이 발생한 경우, 제어정보 생성부(120)는 해당 멀티콥터가 완전 제어력 가능 상태에서 부분적 제어력 가능 상태로 변경된 것으로 판단할 수 있는데, 여기서 고장 감내 알고리즘은, 앞서 언급한 Periodic Solution이 적용될 수 있다.If the
또 다른 예로, 정보 수신부(110)가 옥타콥터로부터 수집한 고장 구동기의 개수에 관한 정보가 제4 개수 이상일 경우, 제어정보 생성부(120)는 해당 옥타콥터가 부분적 제어력 가능 상태인 것으로 판단할 수 있다.As another example, when the information on the number of fault drivers collected from the octacopter by the
즉, 정보 수집부(110)가 멀티콥터로부터 수집한 전체 구동기의 개수에 관한 정보가 제8 개수이고, 구동기 3개 고장 발생 이후 1개가 추가적으로 고장이 발생한 경우, 제어정보 생성부(120)는 해당 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단할 수 있는데, 여기서 고장 감내 알고리즘은, 앞서 언급한 Periodic Solution이 적용될 수 있다.That is, when the
이때, 제어정보 생성부(120)는, 복수의 구동기 중 잔여하는 정상 구동기의 개수보다 1개 적은 개수의 정상 구동기에서 발생될 수 있는 최대추력의 합과 상기 멀티콥터의 무게를 비교할 수 있다. At this time, the control
일 예로, 정보 수집부(110)가 멀티콥터로부터 수집한 전체 구동기의 개수에 대한 정보가 제8 개수이고, 구동기 제3 개수 고장 발생 이후에 제1 개수가 추가적으로 고장이 발생한 경우, 제어정보 생성부(120)는, 해당 멀티콥터에 잔여하는 정상 구동기의 개수보다 제1 개수 적은 개수인 제3 개수에서 발생될 수 있는 최대추력의 합과 해당 멀티콥터의 무게를 비교할 수 있다.For example, if the
만약, 정상 구동기 제3 개수에서 발생될 수 있는 최대추력의 합이 해당 멀티콥터의 무게보다 클 경우, 제어정보 생성부(120)는 해당 멀티콥터로부터 수집된 고장 구동기의 증가된 개수에 대응하는 고장 감내 알고리즘에 따라 제어정보를 업데이트 할 수 있다. 이때, 제어정보 생성부(120)는 고장 구동기의 증가된 개수에 대응하는 고장 감내 알고리즘으로 Periodic Solution을 적용할 수 있다.If the sum of the maximum thrust that can be generated in the third number of normal drivers is greater than the weight of the multi-copter, the control
만약, 정상 구동기 제3 개수에서 발생될 수 있는 최대추력의 합이 해당 멀티콥터의 무게보다 작거나 같을 경우, 제어정보 생성부(120)는 해당 멀티콥터로부터 수집된 고장 구동기의 개수가 제1 개수 더 증가되기 전에 고장 구동기 증가 전 개수에 대응하는 고장 감내 알고리즘에 따라 안전착륙을 수행할 수 있다. 이때, 제어정보 생성부(120)는 고장 구동기 증가 전 개수에 대응하는 고장 감내 알고리즘으로 Periodic Solution을 적용할 수 있다.If, when the sum of the maximum thrust that can be generated in the third number of normal drivers is less than or equal to the weight of the multi-copter, the control
구동 제어부(130)는 생성된 제어정보에 따라 멀티콥터의 구동을 제어할 수 있다.The driving
구동 제어부(130)는 제어정보 생성부(120)에서 생성된 멀티콥터의 제어정보에 따라 해당 멀티콥터의 구동을 제어할 수 있다.The driving
본원의 일 실시예에 따른 정보 수집부(110), 제어정보 생성부(120) 및 구동 제어부(130)는 반복적으로 수행될 수 있다. 본원의 정보 수집부(110), 제어정보 생성부(120) 및 구동 제어부(130)가 반복적으로 수행됨에 따라, 멀티콥터의 비행 상황을 실시간으로 확인할 수 있고, 멀티콥터의 구동기의 고장으로 인해 발생될 수 있는 안전사고를 미연에 방지할 수 있다.The
도 6은 본원의 일 실시예에 따른 멀티콥터 구동 제어 장치 및 방법에서 멀티콥터의 전체적인 동작 흐름을 나타낸 도면이다.6 is a view showing the overall operation flow of a multicopter in a multicopter driving control apparatus and method according to an embodiment of the present application.
도 6을 참조하면, 정보 수집부(110)는 멀티콥터로부터 고장 구동기의 개수에 관한 정보를 포함하는 고장 정보를 수집할 수 있다. 고장 정보로는 고장 구동기가 구비된 멀티콥터의 전체 구동기의 개수에 관한 정보 및 고장이 발생한 구동기 부품의 종류에 관한 정보를 더 포함할 수 있다.Referring to FIG. 6, the
제어정보 생성부(120)는 수집된 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 멀티콥터의 제어정보를 생성할 수 있다.The control
제어정보 생성부(120)는, 전체 구동기의 개수가 6개 이상이면, 복수의 구동기 중 하나 이상의 고장 발생시 고장 구동기의 개수에 기초하여 멀티콥터가 완전 제어력 가능 상태 및 부분 제어력 가능 상태 중 어느 상태인지 판단하고, 전체 구동기의 개수가 6개 미만이면, 복수의 구동기 중 하나 이상의 고장 발생시 고장 구동기의 개수와 무관하게 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단할 수 있다.If the total number of drivers is 6 or more, the control
즉, 제어정보 생성부(120)는, 전체 구동기의 개수가 6개 또는 8개인 핵사콥터 또는 옥타콥터인 경우, 복수의 구동기 중 하나 이상의 고장 발생시, 고장 구동기의 개수에 기초하여 멀티콥터가 완전 제어력 가능상태 및 부분 제어력 가능 상태 중 어느 상태인지 판단할 수 있다.That is, the control
또한, 제어정보 생성부(120)는, 전체 구동기의 개수가 6개 미만인 쿼터콥터인 경우, 복수의 구동기 중 하나 이상의 고장 발생시 고장 구동기의 개수와 무관하게 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단할 수 있다.In addition, the control
이때, 앞서 언급한 바와 같이, 멀티콥터가 완전 제어력 가능 상태인 것으로 판단되면, 제어정보 생성부(120)는 고장 감내 알고리즘으로 PI Method를 적용할 수 있고, 멀티콥터가 부분 제어력 가능 상태인 것으로 판단되면, 제어정보 생성부(120)는 고장 감내 알고리즘으로 Periodic Solution을 적용할 수 있다. 만약, 헥사콥터의 고장 구동기의 개수가 1개이고, 옥타콥터의 고장 구동기의 개수가 1개 내지 2개일 경우, 완전 제어력 가능 상태로 판단되어, 고장 감내 알고리즘으로 PI Method가 적용될 수 있다. 또한, 고장이 지속적으로 확산되어 쿼드콥터의 고장 구동기의 개수가 1개 내지 3개이고, 헥사콥터의 고장 구동기의 개수가 2개 내지 6개이고, 옥타콥터의 고장 구동기의 개수가 3개 내지 7개인 경우, 부분적 제어력 가능 상태로 판단되어, 고장 감내 알고리즘으로 Periodic Solution이 적용될 수 있다. 고장 감내 알고리즘이 적용된 후에는 사용자의 결정에 따라 지속 운용할지, 안전 착륙할지에 대한 여부가 결정될 수 있다.At this time, as described above, if it is determined that the multicopter is in a state in which complete control is possible, the control
이하에서는 상기에 자세히 설명된 내용을 기반으로, 본원의 동작 흐름을 간단히 살펴보기로 한다.Hereinafter, based on the details described above, the operation flow of the present application will be briefly described.
도 7은 본원의 일 실시예에 따른 멀티콥터 구동 제어 방법에 대한 동작 흐름도이다.7 is an operation flowchart for a multicopter driving control method according to an embodiment of the present application.
도 7에 도시된 멀티콥터 구동 제어 방법은 앞서 설명된 멀티콥터 구동 제어 장치(100)에 의하여 수행될 수 있다. 따라서, 이하 생략된 내용이라고 하더라도 멀티콥터 구동 제어 장치(100)에 대하여 설명된 내용은 멀티콥터 구동 제어 방법에 대한 설명에도 동일하게 적용될 수 있다.The multicopter driving control method illustrated in FIG. 7 may be performed by the multicopter driving
도 7을 참조하면, 멀티콥터 구동 제어 장치(100)는 복수의 구동기 중 하나 이상의 고장 발생시 멀티콥터로부터 고장 구동기의 개수에 관한 정보를 포함하는 고장 정보를 수집할 수 있다(S710). Referring to FIG. 7, the multicopter driving
다음으로, 수집된 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 멀티콥터의 제어정보를 생성할 수 있다(S720).Next, the control information of the multicopter may be generated based on the fault tolerance algorithm corresponding to the collected fault information (S720).
여기서 고장 감내 알고리즘은, 전체 구동기의 개수와 대비한 고장 구동기의 개수에 기초하여 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하여 결정될 수 있다.Here, the fault tolerance algorithm may be determined by determining whether the multicopter is in a fully controllable state or a partial controllable state based on the number of faulty drivers compared to the total number of drivers.
이때, 부분적 제어력 가능 상태는, 완전 제어력 가능 상태보다 구동기의 고장이 확산되어 고장 구동기의 개수가 증가된 상태일 수 있다.At this time, the partial control force enabled state may be a state in which the number of faulty drivers is increased due to the failure of the driver spreading over the full controllable state.
단계 S720에서, 고장 구동기의 개수가 제1 개수에 도달하면, 멀티콥터가 완전 제어력 가능 상태인 것으로 판단하고, 고장 구동기의 개수가 제1 개수보다 큰 제2 개수에 도달하면, 멀티콥터가 완전 제어력 가능 상태에서 부분적 제어력 가능 상태로 변경된 것으로 판단할 수 있다.In step S720, when the number of faulty drivers reaches the first number, it is determined that the multicopter is in full controllability, and when the number of faulty drivers reaches the second number greater than the first number, the multicopter fully controls It can be judged that the control state has been changed from the possible state to the partially controllable state.
단계 S720은, 단계 S710에서 수집된 고장 구동기의 개수가 증가되면, 고장 구동기의 증가된 개수에 대응하여 제어정보를 업데이트할 수 있다.In step S720, when the number of fault drivers collected in step S710 is increased, control information may be updated in response to the increased number of fault drivers.
단계 S720은, 복수의 구동기 중 잔여하는 정상 구동기의 개수보다 1개 적은 개수의 정상 구동기에서 발생될 수 있는 최대추력의 합과 멀티콥터의 무게를 비교하고, 최대추력의 합이 멀티콥터의 무게보다 클 경우, 단계 S710에서 수집된 고장 구동기의 개수가 1개 도 증가되더라도 고장 구동기의 증가된 개수에 대응하는 고장 감내 알고리즘에 따라 제어정보를 업데이트 하고, 최대추력의 합이 멀티콥터의 무게보다 작을 경우, 단계 S710에서 수집된 고장 구동기의 개수가 1개 더 증가되기 전에 고장 구동기의 증가 전 개수에 대응하는 고장 감내 알고리즘에 따라 안전착륙을 수행할 수 있다.In step S720, the sum of the maximum thrust and the multicopter weight that can be generated in one less number of normal drivers than the number of remaining normal drivers among the plurality of drivers is compared, and the sum of the maximum thrust is greater than the weight of the multicopter. If large, the control information is updated according to the fault tolerance algorithm corresponding to the increased number of faulty drivers even if the number of faulty drivers collected in step S710 is increased by one degree, and the sum of the maximum thrust is less than the weight of the multicopter , Before the number of the faulty drivers collected in step S710 is increased by one more, a safe landing may be performed according to a fault tolerance algorithm corresponding to the number before the increase of the faulty drivers.
단계 S720에서, 전체 구동기의 개수가 6개 이상이면, 복수의 구동기 중 하나 이상의 고장 발생시 고장 구동기의 개수에 기초하여 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하고, 전체 구동기의 개수가 6개 미만이면, 복수의 구동기 중 하나 이상의 고장 발생시 고장 구동기의 개수와 무관하게 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단할 수 있다.In step S720, if the total number of drivers is 6 or more, it is determined whether the multicopter is in a fully controllable state or a partial controllable state, based on the number of faulty drivers when one or more of the plurality of actuators fail. If the number of is less than 6, when one or more of the plurality of actuators fail, it can be determined that the multicopter is partially controllable regardless of the number of faulty drivers.
단계 S720에서, 멀티콥터가 완전 제어 가능 상태인 것으로 판단되면, 고장 감내 알고리즘으로 PI Method(Pseudo Inverse Method)를 적용할 수 있는데, PI Method는, 멀티콥터의 추락 방지를 위해 복수의 구동기 중 잔여하는 정상 구동기의 요구 회전속도를 멀티콥터의 추력 및 회전 병렬 관계식을 통해 유도하여 적용하는 알고리즘일 수 있다.In step S720, if it is determined that the multicopter is in a fully controllable state, a PI method (Pseudo Inverse Method) may be applied as a fault-tolerance algorithm, and the PI method remains among a plurality of drivers to prevent the multicopter from falling. It may be an algorithm that derives and applies the required rotational speed of a normal actuator through a parallel relationship of thrust and rotation of a multicopter.
또한, 단계 S720에서, 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단되면, 고장 감내 알고리즘으로 Periodic Solution을 적용할 수 있는데, Periodic Solution은, 멀티콥터의 요축 제어를 포기하면서 기체방향 벡터, 각속도 및 위치를 제어함으로써 멀티콥터의 추락을 방지하면서 안전착륙을 수행하는 알고리즘일 수 있다.In addition, in step S720, if it is determined that the multicopter is in a partially controllable state, a periodic solution can be applied as a fault tolerance algorithm, while the periodic solution abandons control of the multicopter's yaw axis and sets the gas direction vector, angular velocity and position. By controlling, it can be an algorithm that performs safe landing while preventing the multicopter from falling.
다음으로, 생성된 제어정보에 따라 멀티콥터의 구동을 제어할 수 있다(S730). 단계 S710 내지 단계 S730은 반복적으로 수행될 수 있다.Next, it is possible to control the operation of the multicopter according to the generated control information (S730). Steps S710 to S730 may be repeatedly performed.
상술한 설명에서, 단계 S710 내지 S730은 본원의 구현예에 따라서, 추가적인 단계들로 더 분할되거나, 더 적은 단계들로 조합될 수 있다. 또한, 일부 단계는 필요에 따라 생략될 수도 있고, 단계 간의 순서가 변경될 수도 있다.In the above description, steps S710 to S730 may be further divided into additional steps or combined into fewer steps, depending on the implementation of the present application. Also, some steps may be omitted if necessary, and the order between the steps may be changed.
본원의 일 실시 예에 따른 멀티콥터 구동 제어 방법은 다양한 컴퓨터 수단을 통하여 수행될 수 있는 프로그램 명령 형태로 구현되어 컴퓨터 판독 가능 매체에 기록될 수 있다. 상기 컴퓨터 판독 가능 매체는 프로그램 명령, 데이터 파일, 데이터 구조 등을 단독으로 또는 조합하여 포함할 수 있다. 상기 매체에 기록되는 프로그램 명령은 본 발명을 위하여 특별히 설계되고 구성된 것들이거나 컴퓨터 소프트웨어 당업자에게 공지되어 사용 가능한 것일 수도 있다. 컴퓨터 판독 가능 기록 매체의 예에는 하드 디스크, 플로피 디스크 및 자기 테이프와 같은 자기 매체(magnetic media), CD-ROM, DVD와 같은 광기록 매체(optical media), 플롭티컬 디스크(floptical disk)와 같은 자기-광 매체(magneto-optical media), 및 롬(ROM), 램(RAM), 플래시 메모리 등과 같은 프로그램 명령을 저장하고 수행하도록 특별히 구성된 하드웨어 장치가 포함된다. 프로그램 명령의 예에는 컴파일러에 의해 만들어지는 것과 같은 기계어 코드뿐만 아니라 인터프리터 등을 사용해서 컴퓨터에 의해서 실행될 수 있는 고급 언어 코드를 포함한다. 상기된 하드웨어 장치는 본 발명의 동작을 수행하기 위해 하나 이상의 소프트웨어 모듈로서 작동하도록 구성될 수 있으며, 그 역도 마찬가지이다.The multi-copter driving control method according to an embodiment of the present application may be implemented in a form of program instructions that can be executed through various computer means and recorded in a computer-readable medium. The computer-readable medium may include program instructions, data files, data structures, or the like alone or in combination. The program instructions recorded on the medium may be specially designed and configured for the present invention, or may be known and usable by those skilled in computer software. Examples of computer-readable recording media include magnetic media such as hard disks, floppy disks, and magnetic tapes, optical media such as CD-ROMs, DVDs, and magnetic media such as floptical disks. -Hardware devices specifically configured to store and execute program instructions such as magneto-optical media, and ROM, RAM, flash memory, and the like. Examples of program instructions include high-level language codes that can be executed by a computer using an interpreter, etc., as well as machine language codes produced by a compiler. The hardware device described above may be configured to operate as one or more software modules to perform the operation of the present invention, and vice versa.
또한, 전술한 멀티콥터 구동 제어 방법은 기록 매체에 저장되는 컴퓨터에 의해 실행되는 컴퓨터 프로그램 또는 애플리케이션의 형태로도 구현될 수 있다.In addition, the above-described multicopter driving control method may also be implemented in the form of a computer program or application executed by a computer stored in a recording medium.
전술한 본원의 설명은 예시를 위한 것이며, 본원이 속하는 기술분야의 통상의 지식을 가진 자는 본원의 기술적 사상이나 필수적인 특징을 변경하지 않고서 다른 구체적인 형태로 쉽게 변형이 가능하다는 것을 이해할 수 있을 것이다. 그러므로 이상에서 기술한 실시예들은 모든 면에서 예시적인 것이며 한정적이 아닌 것으로 이해해야만 한다. 예를 들어, 단일형으로 설명되어 있는 각 구성 요소는 분산되어 실시될 수도 있으며, 마찬가지로 분산된 것으로 설명되어 있는 구성 요소들도 결합된 형태로 실시될 수 있다.The above description of the present application is for illustrative purposes, and those skilled in the art to which the present application pertains will understand that it is possible to easily modify to other specific forms without changing the technical spirit or essential features of the present application. Therefore, it should be understood that the embodiments described above are illustrative in all respects and not restrictive. For example, each component described as a single type may be implemented in a distributed manner, and similarly, components described as distributed may be implemented in a combined form.
본원의 범위는 상기 상세한 설명보다는 후술하는 특허청구범위에 의하여 나타내어지며, 특허청구범위의 의미 및 범위 그리고 그 균등 개념으로부터 도출되는 모든 변경 또는 변형된 형태가 본원의 범위에 포함되는 것으로 해석되어야 한다.The scope of the present application is indicated by the claims below, rather than the detailed description, and it should be interpreted that all modifications or variations derived from the meaning and scope of the claims and equivalent concepts thereof are included in the scope of the present application.
100: 멀티콥터 구동 제어 장치
110: 정보 수집부
120: 제어정보 생성부
130: 구동 제어부100: multicopter drive control device
110: information collection department
120: control information generation unit
130: drive control
Claims (12)
(a) 상기 복수의 구동기 중 하나 이상의 고장 발생시 상기 멀티콥터로부터 고장 구동기의 개수에 관한 정보를 포함하는 고장 정보를 수집하는 단계;
(b) 수집된 상기 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 상기 멀티콥터의 제어정보를 생성하는 단계; 및
(c) 생성된 상기 제어정보에 따라 상기 멀티콥터의 구동을 제어하는 단계를 포함하고,
상기 고장 감내 알고리즘은, 전체 구동기의 개수와 대비한 상기 고장 구동기의 개수에 기초하여 상기 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하여 결정되고,
상기 부분적 제어력 가능 상태는, 상기 완전 제어력 가능 상태보다 구동기의 고장이 확산되어 고장 구동기의 개수가 증가된 상태인 것이고,
상기 (a) 단계 내지 상기 (c) 단계는 반복적으로 수행되고,
상기 (b) 단계에서,
상기 고장 구동기의 개수가 제1 개수에 도달하면, 상기 멀티콥터가 상기 완전 제어력 가능 상태인 것으로 판단하고,
상기 고장 구동기의 개수가 상기 제1 개수보다 큰 제2 개수에 도달하면, 상기 멀티콥터가 상기 완전 제어력 가능 상태에서 상기 부분적 제어력 가능 상태로 변경된 것으로 판단하는 것인, 멀티콥터 구동 제어 방법.In the method of controlling the driving of a multicopter having a plurality of drivers,
(a) collecting failure information including information on the number of failure drivers from the multicopter when one or more of the plurality of drivers fails;
(b) generating control information of the multicopter based on a fault tolerance algorithm corresponding to the collected fault information; And
(c) controlling the operation of the multicopter according to the generated control information,
The fault tolerance algorithm is determined by determining whether the multicopter is in a fully controllable state or a partial controllable state based on the number of faulty drivers compared to the total number of drivers,
The partial control force enabled state is a state in which the number of faulty drivers is increased due to the failure of the driver spreading over the full controllable state,
Steps (a) to (c) are repeatedly performed,
In step (b),
When the number of the faulty drivers reaches the first number, it is determined that the multicopter is in the state of full controllability,
When the number of the faulty driver reaches a second number greater than the first number, it is determined that the multicopter is changed from the fully controllable state to the partially controllable state.
상기 (b) 단계는, 상기 (a) 단계에서 수집된 상기 고장 구동기의 개수가 증가되면, 상기 고장 구동기의 증가된 개수에 대응하여 상기 제어정보를 업데이트하는 것인, 멀티콥터 구동 제어 방법.According to claim 1,
In the step (b), when the number of the fault drivers collected in the step (a) is increased, updating the control information corresponding to the increased number of fault drivers, the multicopter driving control method.
상기 (b) 단계는,
상기 복수의 구동기 중 잔여하는 정상 구동기의 개수보다 1개 적은 개수의 정상 구동기에서 발생될 수 있는 최대추력의 합과 상기 멀티콥터의 무게를 비교하고,
상기 최대추력의 합이 상기 멀티콥터의 무게보다 클 경우 상기 (a) 단계에서 수집된 상기 고장 구동기의 개수가 1개 더 증가되더라도 상기 고장 구동기의 증가된 개수에 대응하는 고장 감내 알고리즘에 따라 상기 제어정보를 업데이트하고,
상기 최대추력의 합이 상기 멀티콥터의 무게보다 작을 경우 상기 (a) 단계에서 수집된 상기 고장 구동기의 개수가 1개 더 증가되기 전에 상기 고장 구동기의 증가 전 개수에 대응하는 고장 감내 알고리즘에 따라 안전착륙을 수행하는 것인, 멀티콥터 구동 제어 방법.According to claim 1,
Step (b) is,
Comparing the weight of the multicopter with the sum of the maximum thrust that can be generated in one less number of normal drivers than the number of remaining normal ones among the plurality of drivers,
When the sum of the maximum thrust is greater than the weight of the multicopter, the control according to the fault tolerance algorithm corresponding to the increased number of the faulty drivers even if the number of the faulty drivers collected in step (a) is increased by one more Update information,
If the sum of the maximum thrust is less than the weight of the multicopter, it is safe according to the fault tolerance algorithm corresponding to the number before the increase in the number of faulty drivers before the number of the faulty drivers collected in step (a) is increased by one more. A method of controlling a multicopter driving by performing landing.
상기 (b) 단계에서,
상기 전체 구동기의 개수가 6개 이상이면, 상기 복수의 구동기 중 하나 이상의 고장 발생시 상기 고장 구동기의 개수에 기초하여 상기 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하고,
상기 전체 구동기의 개수가 6개 미만이면, 상기 복수의 구동기 중 하나 이상의 고장 발생시 상기 고장 구동기의 개수와 무관하게 상기 멀티콥터가 부분적 제어력 가능 상태인 것으로 판단하는 것인, 멀티콥터 구동 제어 방법.According to claim 1,
In step (b),
If the total number of actuators is 6 or more, it is determined whether the multicopter is in a state of full controllability or partial controllability based on the number of faulty drivers when one or more of the plurality of actuators fail,
If the total number of actuators is less than 6, when one or more of the plurality of actuators fail, it is determined that the multicopter is in a state capable of partially controlling regardless of the number of the faulty drivers.
상기 (b) 단계에서, 상기 멀티콥터가 상기 완전 제어력 가능 상태인 것으로 판단되면, 고장 감내 알고리즘으로 PI Method(Pseudo Inverse Method)를 적용하는 것인, 멀티콥터 구동 제어 방법.According to claim 1,
In the step (b), if it is determined that the multicopter is in a state in which the full control power is available, a multi-copter driving control method is applied by applying a PI Inverse Method (PI Method) as a fault tolerance algorithm.
상기 PI Method는, 상기 멀티콥터의 추락 방지를 위해 상기 복수의 구동기 중 잔여하는 정상 구동기의 요구 회전속도를 상기 멀티콥터의 추력 및 회전 병렬 관계식을 통해 유도하여 적용하는 알고리즘인 것인, 멀티콥터 구동 제어 방법.The method of claim 7,
The PI Method is a multicopter driving algorithm that derives and applies the required rotational speed of the normal driver remaining among the plurality of actuators through the parallel relation of thrust and rotation of the multicopter to prevent the multicopter from falling. Control method.
상기 (b) 단계에서, 상기 멀티콥터가 상기 부분적 제어력 가능 상태인 것으로 판단되면, 고장 감내 알고리즘으로 Periodic Solution을 적용하는 것인, 멀티콥터 구동 제어 방법.The method of claim 7,
In step (b), if it is determined that the multicopter is in a state capable of partially controlling, applying a periodic solution with a fault tolerance algorithm, the multicopter driving control method.
상기 Periodic Solution은, 상기 멀티콥터의 요축 제어를 포기하면서 기체방향 벡터, 각속도 및 위치를 제어함으로써 상기 멀티콥터의 추락을 방지하면서 안전착륙을 수행하는 알고리즘인 것인, 멀티콥터 구동 제어 방법.The method of claim 9,
The Periodic Solution is an algorithm that performs a safe landing while preventing a fall of the multicopter by controlling a gas direction vector, an angular velocity, and a position while abandoning the yaw axis control of the multicopter.
상기 복수의 구동기 중 하나 이상의 고장 발생시 상기 멀티콥터로부터 고장 구동기의 개수에 관한 정보를 포함하는 고장 정보를 수집하는 정보 수집부;
수집된 상기 고장 정보에 대응하는 고장 감내 알고리즘에 기초하여 상기 멀티콥터의 제어정보를 생성하는 제어정보 생성부; 및
생성된 상기 제어정보에 따라 상기 멀티콥터의 구동을 제어하는 구동 제어부를 포함하고,
상기 고장 감내 알고리즘은, 전체 구동기의 개수와 대비한 상기 고장 구동기의 개수에 기초하여 상기 멀티콥터가 완전 제어력 가능 상태 및 부분적 제어력 가능 상태 중 어느 상태인지 판단하여 결정되고,
상기 부분적 제어력 가능 상태는, 상기 완전 제어력 가능 상태보다 구동기의 고장이 확산되어 고장 구동기의 개수가 증가된 상태인 것이고,
상기 정보 수집부에 의해 고장 정보를 수집하는 과정, 상기 제어정보 생성부에 의해 제어정보를 생성하는 과정, 및 상기 구동 제어부에 의해 구동을 제어하는 과정은 반복적으로 수행되고,
상기 제어정보 생성부는,
상기 고장 구동기의 개수가 제1 개수에 도달하면, 상기 멀티콥터가 상기 완전 제어력 가능 상태인 것으로 판단하고,
상기 고장 구동기의 개수가 상기 제1 개수보다 큰 제2 개수에 도달하면, 상기 멀티콥터가 상기 완전 제어력 가능 상태에서 상기 부분적 제어력 가능 상태로 변경된 것으로 판단하는 것인, 멀티콥터 구동 제어 장치.In the apparatus for controlling the driving of a multicopter having a plurality of drivers,
An information collecting unit that collects failure information including information on the number of failure drivers from the multicopter when one or more of the plurality of drivers fails;
A control information generating unit generating control information of the multicopter based on a fault tolerance algorithm corresponding to the collected fault information; And
It includes a driving control unit for controlling the operation of the multi-copter according to the generated control information,
The fault tolerance algorithm is determined by determining whether the multicopter is in a fully controllable state or a partial controllable state based on the number of faulty drivers compared to the total number of drivers,
The partial control force enabled state is a state in which the number of faulty drivers is increased due to the failure of the driver spreading over the full controllable state,
The process of collecting fault information by the information collection unit, the process of generating control information by the control information generation unit, and the process of controlling driving by the drive control unit are repeatedly performed,
The control information generation unit,
When the number of the faulty drivers reaches the first number, it is determined that the multicopter is in the state of full controllability,
When the number of the faulty drivers reaches a second number greater than the first number, it is determined that the multicopter is changed from the fully controllable state to the partially controllable state.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020180105102A KR102125259B1 (en) | 2018-09-04 | 2018-09-04 | Apparatus and method for multi-copter drive control |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020180105102A KR102125259B1 (en) | 2018-09-04 | 2018-09-04 | Apparatus and method for multi-copter drive control |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20200027154A KR20200027154A (en) | 2020-03-12 |
KR102125259B1 true KR102125259B1 (en) | 2020-06-22 |
Family
ID=69803171
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020180105102A KR102125259B1 (en) | 2018-09-04 | 2018-09-04 | Apparatus and method for multi-copter drive control |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102125259B1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20240063314A (en) | 2022-11-02 | 2024-05-10 | 세종대학교산학협력단 | Fault-tolerant control apparatus of multicopter and operating method thereof |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160023755A1 (en) * | 2014-05-05 | 2016-01-28 | King Fahd University Of Petroleum And Minerals | System and method for control of quadrotor air vehicles with tiltable rotors |
-
2018
- 2018-09-04 KR KR1020180105102A patent/KR102125259B1/en active IP Right Grant
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160023755A1 (en) * | 2014-05-05 | 2016-01-28 | King Fahd University Of Petroleum And Minerals | System and method for control of quadrotor air vehicles with tiltable rotors |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20240063314A (en) | 2022-11-02 | 2024-05-10 | 세종대학교산학협력단 | Fault-tolerant control apparatus of multicopter and operating method thereof |
Also Published As
Publication number | Publication date |
---|---|
KR20200027154A (en) | 2020-03-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Nan et al. | Nonlinear MPC for quadrotor fault-tolerant control | |
Bucki et al. | Design and control of a passively morphing quadcopter | |
CN112041229B (en) | Aircraft and method for propelling an aircraft | |
Sharifi et al. | Fault tolerant control of a quadrotor UAV using sliding mode control | |
Saied et al. | Fault diagnosis and fault-tolerant control strategy for rotor failure in an octorotor | |
Liu et al. | Retrofit fault‐tolerant tracking control design of an unmanned quadrotor helicopter considering actuator dynamics | |
Ranjbaran et al. | Fault recovery of an under-actuated quadrotor aerial vehicle | |
Sadeghzadeh et al. | Control allocation and re-allocation for a modified quadrotor helicopter against actuator faults | |
JPWO2018110598A1 (en) | Unmanned aerial vehicle, unmanned aerial vehicle control device, unmanned aerial vehicle control method, and unmanned aerial vehicle failure detection device | |
Li et al. | Fault-tolerant cooperative control for multiple UAVs based on sliding mode techniques | |
Pose et al. | Hexacopter fault tolerant actuator allocation analysis for optimal thrust | |
Dos Santos et al. | Bank of controllers and virtual thrusters for fault-tolerant control of autonomous underwater vehicles | |
Lee et al. | Fail-safe flight of a fully-actuated quadrotor in a single motor failure | |
Falconí et al. | Hexacopter outdoor flight test results using adaptive control allocation subject to an unknown complete loss of one propeller | |
KR102125259B1 (en) | Apparatus and method for multi-copter drive control | |
Sun et al. | Upset recovery control for quadrotors subjected to a complete rotor failure from large initial disturbances | |
Jo et al. | Experimental study of in-flight deployment of a multicopter from a fixed-wing UAV | |
Kim et al. | Assured contingency landing management for advanced air mobility | |
Pose et al. | Actuator fault detection in a hexacopter using machine learning | |
Jiao et al. | Fault tolerant control algorithm of hexarotor UAV | |
Benzaid et al. | A generalized dynamical model and control approach applied to multirotor aerial systems | |
Saied et al. | Controllability analysis and motors failures symmetry in a coaxial octorotor | |
Tashreef et al. | Design of a crash-resistant PD-controlled quadcopter using coaxial propeller system | |
Thanaraj et al. | Active fault tolerant control on multi-rotor UAVs using ELM-based neuro-fuzzy system | |
US11921521B2 (en) | Method of controlling an aircraft, flight control device for an aircraft, and aircraft with such flight control device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant |